1 /*
2 * Linux rfkill helper functions for driver wrappers
3 * Copyright (c) 2010, Jouni Malinen <j@w1.fi>
4 *
5 * This software may be distributed under the terms of the BSD license.
6 * See README for more details.
7 */
8
9 #include "includes.h"
10 #include <fcntl.h>
11 #include <limits.h>
12
13 #include "utils/common.h"
14 #include "utils/eloop.h"
15 #include "rfkill.h"
16
17 #define RFKILL_EVENT_SIZE_V1 8
18
19 struct rfkill_event {
20 u32 idx;
21 u8 type;
22 u8 op;
23 u8 soft;
24 u8 hard;
25 } STRUCT_PACKED;
26
27 enum rfkill_operation {
28 RFKILL_OP_ADD = 0,
29 RFKILL_OP_DEL,
30 RFKILL_OP_CHANGE,
31 RFKILL_OP_CHANGE_ALL,
32 };
33
34 enum rfkill_type {
35 RFKILL_TYPE_ALL = 0,
36 RFKILL_TYPE_WLAN,
37 RFKILL_TYPE_BLUETOOTH,
38 RFKILL_TYPE_UWB,
39 RFKILL_TYPE_WIMAX,
40 RFKILL_TYPE_WWAN,
41 RFKILL_TYPE_GPS,
42 RFKILL_TYPE_FM,
43 NUM_RFKILL_TYPES,
44 };
45
46
47 struct rfkill_data {
48 struct rfkill_config *cfg;
49 int fd;
50 int blocked;
51 uint32_t idx;
52 };
53
54
rfkill_receive(int sock,void * eloop_ctx,void * sock_ctx)55 static void rfkill_receive(int sock, void *eloop_ctx, void *sock_ctx)
56 {
57 struct rfkill_data *rfkill = eloop_ctx;
58 struct rfkill_event event;
59 ssize_t len;
60 int new_blocked;
61
62 len = read(rfkill->fd, &event, sizeof(event));
63 if (len < 0) {
64 wpa_printf(MSG_ERROR, "rfkill: Event read failed: %s",
65 strerror(errno));
66 return;
67 }
68 if (len != RFKILL_EVENT_SIZE_V1) {
69 wpa_printf(MSG_DEBUG, "rfkill: Unexpected event size "
70 "%d (expected %d)",
71 (int) len, RFKILL_EVENT_SIZE_V1);
72 return;
73 }
74 if (event.op != RFKILL_OP_CHANGE || event.idx != rfkill->idx)
75 return;
76
77 wpa_printf(MSG_DEBUG, "rfkill: event: idx=%u type=%d "
78 "op=%u soft=%u hard=%u",
79 event.idx, event.type, event.op, event.soft,
80 event.hard);
81
82 if (event.hard) {
83 wpa_printf(MSG_INFO, "rfkill: WLAN hard blocked");
84 new_blocked = 1;
85 } else if (event.soft) {
86 wpa_printf(MSG_INFO, "rfkill: WLAN soft blocked");
87 new_blocked = 1;
88 } else {
89 wpa_printf(MSG_INFO, "rfkill: WLAN unblocked");
90 new_blocked = 0;
91 }
92
93 if (new_blocked != rfkill->blocked) {
94 rfkill->blocked = new_blocked;
95 if (new_blocked)
96 rfkill->cfg->blocked_cb(rfkill->cfg->ctx);
97 else
98 rfkill->cfg->unblocked_cb(rfkill->cfg->ctx);
99 }
100 }
101
102
rfkill_init(struct rfkill_config * cfg)103 struct rfkill_data * rfkill_init(struct rfkill_config *cfg)
104 {
105 struct rfkill_data *rfkill;
106 struct rfkill_event event;
107 ssize_t len;
108 char *phy = NULL, *rfk_phy;
109 char buf[24 + IFNAMSIZ + 1];
110 char buf2[31 + 11 + 1];
111 int found = 0;
112
113 rfkill = os_zalloc(sizeof(*rfkill));
114 if (rfkill == NULL)
115 return NULL;
116
117 os_snprintf(buf, sizeof(buf), "/sys/class/net/%s/phy80211",
118 cfg->ifname);
119 phy = realpath(buf, NULL);
120 if (!phy) {
121 wpa_printf(MSG_INFO, "rfkill: Cannot get wiphy information");
122 goto fail;
123 }
124
125 rfkill->cfg = cfg;
126 rfkill->fd = open("/dev/rfkill", O_RDONLY);
127 if (rfkill->fd < 0) {
128 wpa_printf(MSG_INFO, "rfkill: Cannot open RFKILL control "
129 "device");
130 goto fail;
131 }
132
133 if (fcntl(rfkill->fd, F_SETFL, O_NONBLOCK) < 0) {
134 wpa_printf(MSG_ERROR, "rfkill: Cannot set non-blocking mode: "
135 "%s", strerror(errno));
136 goto fail2;
137 }
138
139 for (;;) {
140 len = read(rfkill->fd, &event, sizeof(event));
141 if (len < 0) {
142 if (errno == EAGAIN)
143 break; /* No more entries */
144 wpa_printf(MSG_ERROR, "rfkill: Event read failed: %s",
145 strerror(errno));
146 break;
147 }
148 if (len != RFKILL_EVENT_SIZE_V1) {
149 wpa_printf(MSG_DEBUG, "rfkill: Unexpected event size "
150 "%d (expected %d)",
151 (int) len, RFKILL_EVENT_SIZE_V1);
152 continue;
153 }
154 if (event.op != RFKILL_OP_ADD ||
155 event.type != RFKILL_TYPE_WLAN)
156 continue;
157
158 os_snprintf(buf2, sizeof(buf2),
159 "/sys/class/rfkill/rfkill%d/device", event.idx);
160 rfk_phy = realpath(buf2, NULL);
161 if (!rfk_phy)
162 goto fail2;
163 found = os_strcmp(phy, rfk_phy) == 0;
164 free(rfk_phy);
165
166 if (!found)
167 continue;
168
169 wpa_printf(MSG_DEBUG, "rfkill: initial event: idx=%u type=%d "
170 "op=%u soft=%u hard=%u",
171 event.idx, event.type, event.op, event.soft,
172 event.hard);
173
174 rfkill->idx = event.idx;
175 if (event.hard) {
176 wpa_printf(MSG_INFO, "rfkill: WLAN hard blocked");
177 rfkill->blocked = 1;
178 } else if (event.soft) {
179 wpa_printf(MSG_INFO, "rfkill: WLAN soft blocked");
180 rfkill->blocked = 1;
181 }
182 break;
183 }
184
185 if (!found)
186 goto fail2;
187
188 free(phy);
189 eloop_register_read_sock(rfkill->fd, rfkill_receive, rfkill, NULL);
190
191 return rfkill;
192
193 fail2:
194 close(rfkill->fd);
195 fail:
196 os_free(rfkill);
197 /* use standard free function to match realpath() */
198 free(phy);
199 return NULL;
200 }
201
202
rfkill_deinit(struct rfkill_data * rfkill)203 void rfkill_deinit(struct rfkill_data *rfkill)
204 {
205 if (rfkill == NULL)
206 return;
207
208 if (rfkill->fd >= 0) {
209 eloop_unregister_read_sock(rfkill->fd);
210 close(rfkill->fd);
211 }
212
213 os_free(rfkill->cfg);
214 os_free(rfkill);
215 }
216
217
rfkill_is_blocked(struct rfkill_data * rfkill)218 int rfkill_is_blocked(struct rfkill_data *rfkill)
219 {
220 if (rfkill == NULL)
221 return 0;
222
223 return rfkill->blocked;
224 }
225