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