1 /* 2 * iwinfo - Wireless Information Library - Shared utility routines 3 * 4 * Copyright (C) 2010 Jo-Philipp Wich <xm@subsignal.org> 5 * 6 * The iwinfo library is free software: you can redistribute it and/or 7 * modify it under the terms of the GNU General Public License version 2 8 * as published by the Free Software Foundation. 9 * 10 * The iwinfo library is distributed in the hope that it will be useful, 11 * but WITHOUT ANY WARRANTY; without even the implied warranty of 12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. 13 * See the GNU General Public License for more details. 14 * 15 * You should have received a copy of the GNU General Public License along 16 * with the iwinfo library. If not, see http://www.gnu.org/licenses/. 17 * 18 * The signal handling code is derived from the official madwifi tools, 19 * wlanconfig.c in particular. The encryption property handling was 20 * inspired by the hostapd madwifi driver. 21 */ 22 23 #include "iwinfo/utils.h" 24 25 26 static int ioctl_socket = -1; 27 struct uci_context *uci_ctx = NULL; 28 29 static int iwinfo_ioctl_socket(void) 30 { 31 /* Prepare socket */ 32 if (ioctl_socket == -1) 33 { 34 ioctl_socket = socket(AF_INET, SOCK_DGRAM, 0); 35 fcntl(ioctl_socket, F_SETFD, fcntl(ioctl_socket, F_GETFD) | FD_CLOEXEC); 36 } 37 38 return ioctl_socket; 39 } 40 41 int iwinfo_ioctl(int cmd, void *ifr) 42 { 43 int s = iwinfo_ioctl_socket(); 44 return ioctl(s, cmd, ifr); 45 } 46 47 int iwinfo_dbm2mw(int in) 48 { 49 double res = 1.0; 50 int ip = in / 10; 51 int fp = in % 10; 52 int k; 53 54 for(k = 0; k < ip; k++) res *= 10; 55 for(k = 0; k < fp; k++) res *= LOG10_MAGIC; 56 57 return (int)res; 58 } 59 60 int iwinfo_mw2dbm(int in) 61 { 62 double fin = (double) in; 63 int res = 0; 64 65 while(fin > 10.0) 66 { 67 res += 10; 68 fin /= 10.0; 69 } 70 71 while(fin > 1.000001) 72 { 73 res += 1; 74 fin /= LOG10_MAGIC; 75 } 76 77 return (int)res; 78 } 79 80 int iwinfo_ifup(const char *ifname) 81 { 82 struct ifreq ifr; 83 84 strncpy(ifr.ifr_name, ifname, IFNAMSIZ - 1); 85 86 if (iwinfo_ioctl(SIOCGIFFLAGS, &ifr)) 87 return 0; 88 89 ifr.ifr_flags |= (IFF_UP | IFF_RUNNING); 90 91 return !iwinfo_ioctl(SIOCSIFFLAGS, &ifr); 92 } 93 94 int iwinfo_ifdown(const char *ifname) 95 { 96 struct ifreq ifr; 97 98 strncpy(ifr.ifr_name, ifname, IFNAMSIZ - 1); 99 100 if (iwinfo_ioctl(SIOCGIFFLAGS, &ifr)) 101 return 0; 102 103 ifr.ifr_flags &= ~(IFF_UP | IFF_RUNNING); 104 105 return !iwinfo_ioctl(SIOCSIFFLAGS, &ifr); 106 } 107 108 int iwinfo_ifmac(const char *ifname) 109 { 110 struct ifreq ifr; 111 112 strncpy(ifr.ifr_name, ifname, IFNAMSIZ - 1); 113 114 if (iwinfo_ioctl(SIOCGIFHWADDR, &ifr)) 115 return 0; 116 117 ifr.ifr_hwaddr.sa_data[0] |= 0x02; 118 ifr.ifr_hwaddr.sa_data[1]++; 119 ifr.ifr_hwaddr.sa_data[2]++; 120 121 return !iwinfo_ioctl(SIOCSIFHWADDR, &ifr); 122 } 123 124 void iwinfo_close(void) 125 { 126 if (ioctl_socket > -1) 127 close(ioctl_socket); 128 129 ioctl_socket = -1; 130 } 131 132 struct iwinfo_hardware_entry * iwinfo_hardware(struct iwinfo_hardware_id *id) 133 { 134 FILE *db; 135 char buf[256] = { 0 }; 136 static struct iwinfo_hardware_entry e; 137 struct iwinfo_hardware_entry *rv = NULL; 138 139 if (!(db = fopen(IWINFO_HARDWARE_FILE, "r"))) 140 return NULL; 141 142 while (fgets(buf, sizeof(buf) - 1, db) != NULL) 143 { 144 memset(&e, 0, sizeof(e)); 145 146 if (sscanf(buf, "%hx %hx %hx %hx %hd %hd \"%63[^\"]\" \"%63[^\"]\"", 147 &e.vendor_id, &e.device_id, 148 &e.subsystem_vendor_id, &e.subsystem_device_id, 149 &e.txpower_offset, &e.frequency_offset, 150 e.vendor_name, e.device_name) < 8) 151 continue; 152 153 if ((e.vendor_id != 0xffff) && (e.vendor_id != id->vendor_id)) 154 continue; 155 156 if ((e.device_id != 0xffff) && (e.device_id != id->device_id)) 157 continue; 158 159 if ((e.subsystem_vendor_id != 0xffff) && 160 (e.subsystem_vendor_id != id->subsystem_vendor_id)) 161 continue; 162 163 if ((e.subsystem_device_id != 0xffff) && 164 (e.subsystem_device_id != id->subsystem_device_id)) 165 continue; 166 167 rv = &e; 168 break; 169 } 170 171 fclose(db); 172 return rv; 173 } 174 175 int iwinfo_hardware_id_from_mtd(struct iwinfo_hardware_id *id) 176 { 177 FILE *mtd; 178 uint16_t *bc; 179 180 int fd, off; 181 unsigned int len; 182 char buf[128]; 183 184 if (!(mtd = fopen("/proc/mtd", "r"))) 185 return -1; 186 187 while (fgets(buf, sizeof(buf), mtd) != NULL) 188 { 189 if (fscanf(mtd, "mtd%d: %x %*x %127s", &off, &len, buf) < 3 || 190 (strcmp(buf, "\"boardconfig\"") && strcmp(buf, "\"EEPROM\"") && 191 strcmp(buf, "\"factory\""))) 192 { 193 off = -1; 194 continue; 195 } 196 197 break; 198 } 199 200 fclose(mtd); 201 202 if (off < 0) 203 return -1; 204 205 snprintf(buf, sizeof(buf), "/dev/mtdblock%d", off); 206 207 if ((fd = open(buf, O_RDONLY)) < 0) 208 return -1; 209 210 bc = mmap(NULL, len, PROT_READ, MAP_PRIVATE|MAP_LOCKED, fd, 0); 211 212 if ((void *)bc != MAP_FAILED) 213 { 214 id->vendor_id = 0; 215 id->device_id = 0; 216 217 for (off = len / 2 - 0x800; off >= 0; off -= 0x800) 218 { 219 /* AR531X board data magic */ 220 if ((bc[off] == 0x3533) && (bc[off + 1] == 0x3131)) 221 { 222 id->vendor_id = bc[off + 0x7d]; 223 id->device_id = bc[off + 0x7c]; 224 id->subsystem_vendor_id = bc[off + 0x84]; 225 id->subsystem_device_id = bc[off + 0x83]; 226 break; 227 } 228 229 /* AR5416 EEPROM magic */ 230 else if ((bc[off] == 0xA55A) || (bc[off] == 0x5AA5)) 231 { 232 id->vendor_id = bc[off + 0x0D]; 233 id->device_id = bc[off + 0x0E]; 234 id->subsystem_vendor_id = bc[off + 0x13]; 235 id->subsystem_device_id = bc[off + 0x14]; 236 break; 237 } 238 239 /* Rt3xxx SoC */ 240 else if ((bc[off] == 0x3050) || (bc[off] == 0x5030) || 241 (bc[off] == 0x3051) || (bc[off] == 0x5130) || 242 (bc[off] == 0x3052) || (bc[off] == 0x5230) || 243 (bc[off] == 0x3350) || (bc[off] == 0x5033) || 244 (bc[off] == 0x3352) || (bc[off] == 0x5233) || 245 (bc[off] == 0x3662) || (bc[off] == 0x6236) || 246 (bc[off] == 0x3883) || (bc[off] == 0x8338) || 247 (bc[off] == 0x5350) || (bc[off] == 0x5053)) 248 { 249 /* vendor: RaLink */ 250 id->vendor_id = 0x1814; 251 id->subsystem_vendor_id = 0x1814; 252 253 /* device */ 254 if (((bc[off] & 0xf0) == 0x30) || 255 ((bc[off] & 0xff) == 0x53)) 256 id->device_id = (bc[off] >> 8) | (bc[off] & 0x00ff) << 8; 257 else 258 id->device_id = bc[off]; 259 260 /* subsystem from EEPROM_NIC_CONF0_RF_TYPE */ 261 id->subsystem_device_id = (bc[off + 0x1a] & 0x0f00) >> 8; 262 } else if ((bc[off] == 0x7620) || (bc[off] == 0x2076) || 263 (bc[off] == 0x7628) || (bc[off] == 0x2876) || 264 (bc[off] == 0x7688) || (bc[off] == 0x8876)) { 265 /* vendor: MediaTek */ 266 id->vendor_id = 0x14c3; 267 id->subsystem_vendor_id = 0x14c3; 268 269 /* device */ 270 if ((bc[off] & 0xff) == 0x76) 271 id->device_id = (bc[off] >> 8) | (bc[off] & 0x00ff) << 8; 272 else 273 id->device_id = bc[off]; 274 275 /* subsystem from EEPROM_NIC_CONF0_RF_TYPE */ 276 id->subsystem_device_id = (bc[off + 0x1a] & 0x0f00) >> 8; 277 } 278 } 279 280 munmap(bc, len); 281 } 282 283 close(fd); 284 285 return (id->vendor_id && id->device_id) ? 0 : -1; 286 } 287 288 static void iwinfo_parse_rsn_cipher(uint8_t idx, uint8_t *ciphers) 289 { 290 switch (idx) 291 { 292 case 0: 293 *ciphers |= IWINFO_CIPHER_NONE; 294 break; 295 296 case 1: 297 *ciphers |= IWINFO_CIPHER_WEP40; 298 break; 299 300 case 2: 301 *ciphers |= IWINFO_CIPHER_TKIP; 302 break; 303 304 case 3: /* WRAP */ 305 break; 306 307 case 4: 308 *ciphers |= IWINFO_CIPHER_CCMP; 309 break; 310 311 case 5: 312 *ciphers |= IWINFO_CIPHER_WEP104; 313 break; 314 315 case 6: /* AES-128-CMAC */ 316 case 7: /* No group addressed */ 317 case 8: /* GCMP */ 318 case 9: /* GCMP-256 */ 319 case 10: /* CCMP-256 */ 320 case 11: /* BIP-GMAC-128 */ 321 case 12: /* BIP-GMAC-256 */ 322 case 13: /* BIP-CMAC-256 */ 323 break; 324 } 325 } 326 327 void iwinfo_parse_rsn(struct iwinfo_crypto_entry *c, uint8_t *data, uint8_t len, 328 uint8_t defcipher, uint8_t defauth) 329 { 330 uint16_t i, count; 331 uint8_t wpa_version = 0; 332 333 static unsigned char ms_oui[3] = { 0x00, 0x50, 0xf2 }; 334 static unsigned char ieee80211_oui[3] = { 0x00, 0x0f, 0xac }; 335 336 data += 2; 337 len -= 2; 338 339 if (!memcmp(data, ms_oui, 3)) 340 wpa_version |= 1; 341 else if (!memcmp(data, ieee80211_oui, 3)) 342 wpa_version |= 2; 343 344 if (len < 4) 345 { 346 c->group_ciphers |= defcipher; 347 c->pair_ciphers |= defcipher; 348 c->auth_suites |= defauth; 349 return; 350 } 351 352 if (!memcmp(data, ms_oui, 3) || !memcmp(data, ieee80211_oui, 3)) 353 iwinfo_parse_rsn_cipher(data[3], &c->group_ciphers); 354 355 data += 4; 356 len -= 4; 357 358 if (len < 2) 359 { 360 c->pair_ciphers |= defcipher; 361 c->auth_suites |= defauth; 362 return; 363 } 364 365 count = data[0] | (data[1] << 8); 366 if (2 + (count * 4) > len) 367 return; 368 369 for (i = 0; i < count; i++) 370 if (!memcmp(data + 2 + (i * 4), ms_oui, 3) || 371 !memcmp(data + 2 + (i * 4), ieee80211_oui, 3)) 372 iwinfo_parse_rsn_cipher(data[2 + (i * 4) + 3], &c->pair_ciphers); 373 374 data += 2 + (count * 4); 375 len -= 2 + (count * 4); 376 377 if (len < 2) 378 { 379 c->auth_suites |= defauth; 380 return; 381 } 382 383 count = data[0] | (data[1] << 8); 384 if (2 + (count * 4) > len) 385 return; 386 387 for (i = 0; i < count; i++) 388 { 389 if (!memcmp(data + 2 + (i * 4), ms_oui, 3) || 390 !memcmp(data + 2 + (i * 4), ieee80211_oui, 3)) 391 { 392 switch (data[2 + (i * 4) + 3]) 393 { 394 case 1: /* IEEE 802.1x */ 395 c->wpa_version |= wpa_version; 396 c->auth_suites |= IWINFO_KMGMT_8021x; 397 break; 398 399 case 2: /* PSK */ 400 c->wpa_version |= wpa_version; 401 c->auth_suites |= IWINFO_KMGMT_PSK; 402 break; 403 404 case 3: /* FT/IEEE 802.1X */ 405 case 4: /* FT/PSK */ 406 case 5: /* IEEE 802.1X/SHA-256 */ 407 case 6: /* PSK/SHA-256 */ 408 case 7: /* TPK Handshake */ 409 break; 410 411 case 8: /* SAE */ 412 c->wpa_version |= 4; 413 c->auth_suites |= IWINFO_KMGMT_SAE; 414 break; 415 416 case 9: /* FT/SAE */ 417 case 10: /* undefined */ 418 break; 419 420 case 11: /* 802.1x Suite-B */ 421 case 12: /* 802.1x Suite-B-192 */ 422 c->wpa_version |= 4; 423 c->auth_suites |= IWINFO_KMGMT_8021x; 424 break; 425 426 case 13: /* FT/802.1x SHA-384 */ 427 case 14: /* FILS SHA-256 */ 428 case 15: /* FILS SHA-384 */ 429 case 16: /* FT/FILS SHA-256 */ 430 case 17: /* FT/FILS SHA-384 */ 431 break; 432 433 case 18: /* OWE */ 434 c->wpa_version |= 4; 435 c->auth_suites |= IWINFO_KMGMT_OWE; 436 break; 437 } 438 } 439 } 440 441 data += 2 + (count * 4); 442 len -= 2 + (count * 4); 443 } 444 445 struct uci_section *iwinfo_uci_get_radio(const char *name, const char *type) 446 { 447 struct uci_ptr ptr = { 448 .package = "wireless", 449 .section = name, 450 .flags = (name && *name == '@') ? UCI_LOOKUP_EXTENDED : 0, 451 }; 452 const char *opt; 453 454 if (!uci_ctx) { 455 uci_ctx = uci_alloc_context(); 456 if (!uci_ctx) 457 return NULL; 458 } 459 460 if (uci_lookup_ptr(uci_ctx, &ptr, NULL, true)) 461 return NULL; 462 463 if (!ptr.s || strcmp(ptr.s->type, "wifi-device") != 0) 464 return NULL; 465 466 opt = uci_lookup_option_string(uci_ctx, ptr.s, "type"); 467 if (!opt || strcmp(opt, type) != 0) 468 return NULL; 469 470 return ptr.s; 471 } 472 473 void iwinfo_uci_free(void) 474 { 475 if (!uci_ctx) 476 return; 477 478 uci_free_context(uci_ctx); 479 uci_ctx = NULL; 480 } 481 482 483 struct iwinfo_ubus_query_state { 484 const char *ifname; 485 const char *field; 486 size_t len; 487 char *buf; 488 }; 489 490 static void iwinfo_ubus_query_cb(struct ubus_request *req, int type, 491 struct blob_attr *msg) 492 { 493 struct iwinfo_ubus_query_state *st = req->priv; 494 495 struct blobmsg_policy pol1[2] = { 496 { "ifname", BLOBMSG_TYPE_STRING }, 497 { "config", BLOBMSG_TYPE_TABLE } 498 }; 499 500 struct blobmsg_policy pol2 = { st->field, BLOBMSG_TYPE_STRING }; 501 struct blob_attr *cur, *cur2, *cur3, *cfg[2], *res; 502 int rem, rem2, rem3; 503 504 blobmsg_for_each_attr(cur, msg, rem) { 505 if (blobmsg_type(cur) != BLOBMSG_TYPE_TABLE) 506 continue; 507 508 blobmsg_for_each_attr(cur2, cur, rem2) { 509 if (blobmsg_type(cur2) != BLOBMSG_TYPE_ARRAY) 510 continue; 511 512 if (strcmp(blobmsg_name(cur2), "interfaces")) 513 continue; 514 515 blobmsg_for_each_attr(cur3, cur2, rem3) { 516 blobmsg_parse(pol1, sizeof(pol1) / sizeof(pol1[0]), cfg, 517 blobmsg_data(cur3), blobmsg_len(cur3)); 518 519 if (!cfg[0] || !cfg[1] || 520 strcmp(blobmsg_get_string(cfg[0]), st->ifname)) 521 continue; 522 523 blobmsg_parse(&pol2, 1, &res, 524 blobmsg_data(cfg[1]), blobmsg_len(cfg[1])); 525 526 if (!res) 527 continue; 528 529 strncpy(st->buf, blobmsg_get_string(res), st->len); 530 return; 531 } 532 } 533 } 534 } 535 536 int iwinfo_ubus_query(const char *ifname, const char *field, 537 char *buf, size_t len) 538 { 539 struct iwinfo_ubus_query_state st = { 540 .ifname = ifname, 541 .field = field, 542 .buf = buf, 543 .len = len 544 }; 545 546 struct ubus_context *ctx = NULL; 547 struct blob_buf b = { }; 548 int rv = -1; 549 uint32_t id; 550 551 blob_buf_init(&b, 0); 552 553 ctx = ubus_connect(NULL); 554 555 if (!ctx) 556 goto out; 557 558 if (ubus_lookup_id(ctx, "network.wireless", &id)) 559 goto out; 560 561 if (ubus_invoke(ctx, id, "status", b.head, iwinfo_ubus_query_cb, &st, 250)) 562 goto out; 563 564 rv = 0; 565 566 out: 567 if (ctx) 568 ubus_free(ctx); 569 570 blob_buf_free(&b); 571 572 return rv; 573 } 574
This page was automatically generated by LXR 0.3.1. • OpenWrt