wifi.c 3.2 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126
  1. #include <err.h>
  2. #include <string.h>
  3. #include <sys/ioctl.h>
  4. #include <sys/socket.h>
  5. #include <linux/wireless.h>
  6. #include "wifi.h"
  7. #include "../lib/util.h"
  8. #include "../aslstatus.h"
  9. #define CLEANUP(X) \
  10. static inline void wifi_##X##_cleanup(void *ptr) \
  11. { \
  12. eclose(((struct wifi_##X##_data *)ptr)->common.sock); \
  13. } \
  14. struct trailing_semicolon
  15. #define eioctl(fd, req, arg) _eioctl(__func__, (fd), (req), #req, arg)
  16. static uint8_t
  17. _eioctl(const char *func, int fd, int req, const char *str_req, void *arg);
  18. #define esocket(socket, ...) \
  19. ((socket = _esocket(__func__, #__VA_ARGS__, __VA_ARGS__)) != -1)
  20. static int
  21. _esocket(const char *func, const char *args, int domain, int type, int proto);
  22. #define SOCKET_INIT(DATA, OUT) \
  23. do { \
  24. if (!esocket((DATA)->common.sock, AF_INET, SOCK_DGRAM, 0)) \
  25. ERRRET(OUT); \
  26. } while (0)
  27. static void wifi_perc_cleanup(void *ptr);
  28. static void wifi_essid_cleanup(void *ptr);
  29. void
  30. wifi_perc(char * out,
  31. const char * interface,
  32. uint32_t __unused _i,
  33. static_data_t * static_data)
  34. {
  35. struct wifi_perc_data *data = static_data->data;
  36. if (!static_data->cleanup) static_data->cleanup = wifi_perc_cleanup;
  37. if (data->common.sock <= 0) {
  38. SOCKET_INIT(data, out);
  39. strncpy(data->common.req.ifr_name,
  40. interface,
  41. sizeof(data->common.req.ifr_name));
  42. data->common.req.u.data.pointer = &data->stat;
  43. data->common.req.u.data.length = sizeof(data->stat);
  44. }
  45. if (!eioctl(data->common.sock, SIOCGIWSTATS, &data->common.req)) {
  46. close(data->common.sock);
  47. data->common.sock = -1;
  48. ERRRET(out);
  49. }
  50. bprintf(out,
  51. "%" PRIperc,
  52. (percent_t)((float)data->stat.qual.qual / (70 /* max RSSI */)
  53. * 100));
  54. }
  55. void
  56. wifi_essid(char * out,
  57. const char * interface,
  58. uint32_t __unused _i,
  59. static_data_t * static_data)
  60. {
  61. struct wifi_essid_data *data = static_data->data;
  62. if (!static_data->cleanup) static_data->cleanup = wifi_essid_cleanup;
  63. if (data->common.sock <= 0) {
  64. SOCKET_INIT(data, out);
  65. strncpy(data->common.req.ifr_name,
  66. interface,
  67. sizeof(data->common.req.ifr_name));
  68. data->common.req.u.essid.pointer = data->id;
  69. data->common.req.u.essid.length = sizeof(data->id);
  70. }
  71. if (!eioctl(data->common.sock, SIOCGIWESSID, &data->common.req)) {
  72. close(data->common.sock);
  73. data->common.sock = -1;
  74. ERRRET(out);
  75. }
  76. if (!*data->id) ERRRET(out);
  77. bprintf(out, "%s", data->id);
  78. }
  79. static inline uint8_t
  80. _eioctl(const char *func, int fd, int req, const char *str_req, void *arg)
  81. {
  82. uint8_t ret;
  83. if (!(ret = (ioctl(fd, req, arg) != -1)))
  84. warn("%s: ioctl(%d, %s, %p)", func, fd, str_req, arg);
  85. return ret;
  86. }
  87. static inline int
  88. _esocket(const char *func, const char *args, int domain, int type, int proto)
  89. {
  90. int ret;
  91. if ((ret = socket(domain, type, proto)) == -1)
  92. warn("%s: socket(%s)", func, args);
  93. return ret;
  94. }
  95. CLEANUP(perc);
  96. CLEANUP(essid);