projects / openwrt / staging / stintel.git / blob
? search:


832f40bd3d8bb55d6d9fafe65cddf860d00029ed
[openwrt/staging/stintel.git] / package / iwinfo / src / iwinfo_madwifi.c
1 /*
2 * iwinfo - Wireless Information Library - Madwifi Backend
3 *
4 * Copyright (C) 2009-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/madwifi.h"
24 #include "iwinfo/wext.h"
25
26
27 /*
28 * Madwifi ISO 3166 to Country/Region Code mapping.
29 */
30
31 static struct ISO3166_to_CCode
32 {
33 u_int16_t iso3166;
34 u_int16_t ccode;
35 } CountryCodes[] = {
36 { 0x3030 /* 00 */, 0 }, /* World */
37 { 0x4145 /* AE */, 784 }, /* U.A.E. */
38 { 0x414C /* AL */, 8 }, /* Albania */
39 { 0x414D /* AM */, 51 }, /* Armenia */
40 { 0x4152 /* AR */, 32 }, /* Argentina */
41 { 0x4154 /* AT */, 40 }, /* Austria */
42 { 0x4155 /* AU */, 36 }, /* Australia */
43 { 0x415A /* AZ */, 31 }, /* Azerbaijan */
44 { 0x4245 /* BE */, 56 }, /* Belgium */
45 { 0x4247 /* BG */, 100 }, /* Bulgaria */
46 { 0x4248 /* BH */, 48 }, /* Bahrain */
47 { 0x424E /* BN */, 96 }, /* Brunei Darussalam */
48 { 0x424F /* BO */, 68 }, /* Bolivia */
49 { 0x4252 /* BR */, 76 }, /* Brazil */
50 { 0x4259 /* BY */, 112 }, /* Belarus */
51 { 0x425A /* BZ */, 84 }, /* Belize */
52 { 0x4341 /* CA */, 124 }, /* Canada */
53 { 0x4348 /* CH */, 756 }, /* Switzerland */
54 { 0x434C /* CL */, 152 }, /* Chile */
55 { 0x434E /* CN */, 156 }, /* People's Republic of China */
56 { 0x434F /* CO */, 170 }, /* Colombia */
57 { 0x4352 /* CR */, 188 }, /* Costa Rica */
58 { 0x4359 /* CY */, 196 }, /* Cyprus */
59 { 0x435A /* CZ */, 203 }, /* Czech Republic */
60 { 0x4445 /* DE */, 276 }, /* Germany */
61 { 0x444B /* DK */, 208 }, /* Denmark */
62 { 0x444F /* DO */, 214 }, /* Dominican Republic */
63 { 0x445A /* DZ */, 12 }, /* Algeria */
64 { 0x4543 /* EC */, 218 }, /* Ecuador */
65 { 0x4545 /* EE */, 233 }, /* Estonia */
66 { 0x4547 /* EG */, 818 }, /* Egypt */
67 { 0x4553 /* ES */, 724 }, /* Spain */
68 { 0x4649 /* FI */, 246 }, /* Finland */
69 { 0x464F /* FO */, 234 }, /* Faeroe Islands */
70 { 0x4652 /* FR */, 250 }, /* France */
71 { 0x4652 /* FR */, 255 }, /* France2 */
72 { 0x4742 /* GB */, 826 }, /* United Kingdom */
73 { 0x4745 /* GE */, 268 }, /* Georgia */
74 { 0x4752 /* GR */, 300 }, /* Greece */
75 { 0x4754 /* GT */, 320 }, /* Guatemala */
76 { 0x484B /* HK */, 344 }, /* Hong Kong S.A.R., P.R.C. */
77 { 0x484E /* HN */, 340 }, /* Honduras */
78 { 0x4852 /* HR */, 191 }, /* Croatia */
79 { 0x4855 /* HU */, 348 }, /* Hungary */
80 { 0x4944 /* ID */, 360 }, /* Indonesia */
81 { 0x4945 /* IE */, 372 }, /* Ireland */
82 { 0x494C /* IL */, 376 }, /* Israel */
83 { 0x494E /* IN */, 356 }, /* India */
84 { 0x4951 /* IQ */, 368 }, /* Iraq */
85 { 0x4952 /* IR */, 364 }, /* Iran */
86 { 0x4953 /* IS */, 352 }, /* Iceland */
87 { 0x4954 /* IT */, 380 }, /* Italy */
88 { 0x4A4D /* JM */, 388 }, /* Jamaica */
89 { 0x4A4F /* JO */, 400 }, /* Jordan */
90 { 0x4A50 /* JP */, 392 }, /* Japan */
91 { 0x4A50 /* JP */, 393 }, /* Japan (JP1) */
92 { 0x4A50 /* JP */, 394 }, /* Japan (JP0) */
93 { 0x4A50 /* JP */, 395 }, /* Japan (JP1-1) */
94 { 0x4A50 /* JP */, 396 }, /* Japan (JE1) */
95 { 0x4A50 /* JP */, 397 }, /* Japan (JE2) */
96 { 0x4A50 /* JP */, 399 }, /* Japan (JP6) */
97 { 0x4A50 /* JP */, 900 }, /* Japan */
98 { 0x4A50 /* JP */, 901 }, /* Japan */
99 { 0x4A50 /* JP */, 902 }, /* Japan */
100 { 0x4A50 /* JP */, 903 }, /* Japan */
101 { 0x4A50 /* JP */, 904 }, /* Japan */
102 { 0x4A50 /* JP */, 905 }, /* Japan */
103 { 0x4A50 /* JP */, 906 }, /* Japan */
104 { 0x4A50 /* JP */, 907 }, /* Japan */
105 { 0x4A50 /* JP */, 908 }, /* Japan */
106 { 0x4A50 /* JP */, 909 }, /* Japan */
107 { 0x4A50 /* JP */, 910 }, /* Japan */
108 { 0x4A50 /* JP */, 911 }, /* Japan */
109 { 0x4A50 /* JP */, 912 }, /* Japan */
110 { 0x4A50 /* JP */, 913 }, /* Japan */
111 { 0x4A50 /* JP */, 914 }, /* Japan */
112 { 0x4A50 /* JP */, 915 }, /* Japan */
113 { 0x4A50 /* JP */, 916 }, /* Japan */
114 { 0x4A50 /* JP */, 917 }, /* Japan */
115 { 0x4A50 /* JP */, 918 }, /* Japan */
116 { 0x4A50 /* JP */, 919 }, /* Japan */
117 { 0x4A50 /* JP */, 920 }, /* Japan */
118 { 0x4A50 /* JP */, 921 }, /* Japan */
119 { 0x4A50 /* JP */, 922 }, /* Japan */
120 { 0x4A50 /* JP */, 923 }, /* Japan */
121 { 0x4A50 /* JP */, 924 }, /* Japan */
122 { 0x4A50 /* JP */, 925 }, /* Japan */
123 { 0x4A50 /* JP */, 926 }, /* Japan */
124 { 0x4A50 /* JP */, 927 }, /* Japan */
125 { 0x4A50 /* JP */, 928 }, /* Japan */
126 { 0x4A50 /* JP */, 929 }, /* Japan */
127 { 0x4A50 /* JP */, 930 }, /* Japan */
128 { 0x4A50 /* JP */, 931 }, /* Japan */
129 { 0x4A50 /* JP */, 932 }, /* Japan */
130 { 0x4A50 /* JP */, 933 }, /* Japan */
131 { 0x4A50 /* JP */, 934 }, /* Japan */
132 { 0x4A50 /* JP */, 935 }, /* Japan */
133 { 0x4A50 /* JP */, 936 }, /* Japan */
134 { 0x4A50 /* JP */, 937 }, /* Japan */
135 { 0x4A50 /* JP */, 938 }, /* Japan */
136 { 0x4A50 /* JP */, 939 }, /* Japan */
137 { 0x4A50 /* JP */, 940 }, /* Japan */
138 { 0x4A50 /* JP */, 941 }, /* Japan */
139 { 0x4B45 /* KE */, 404 }, /* Kenya */
140 { 0x4B50 /* KP */, 408 }, /* North Korea */
141 { 0x4B52 /* KR */, 410 }, /* South Korea */
142 { 0x4B52 /* KR */, 411 }, /* South Korea */
143 { 0x4B57 /* KW */, 414 }, /* Kuwait */
144 { 0x4B5A /* KZ */, 398 }, /* Kazakhstan */
145 { 0x4C42 /* LB */, 422 }, /* Lebanon */
146 { 0x4C49 /* LI */, 438 }, /* Liechtenstein */
147 { 0x4C54 /* LT */, 440 }, /* Lithuania */
148 { 0x4C55 /* LU */, 442 }, /* Luxembourg */
149 { 0x4C56 /* LV */, 428 }, /* Latvia */
150 { 0x4C59 /* LY */, 434 }, /* Libya */
151 { 0x4D41 /* MA */, 504 }, /* Morocco */
152 { 0x4D43 /* MC */, 492 }, /* Principality of Monaco */
153 { 0x4D4B /* MK */, 807 }, /* the Former Yugoslav Republic of Macedonia */
154 { 0x4D4F /* MO */, 446 }, /* Macau */
155 { 0x4D58 /* MX */, 484 }, /* Mexico */
156 { 0x4D59 /* MY */, 458 }, /* Malaysia */
157 { 0x4E49 /* NI */, 558 }, /* Nicaragua */
158 { 0x4E4C /* NL */, 528 }, /* Netherlands */
159 { 0x4E4F /* NO */, 578 }, /* Norway */
160 { 0x4E5A /* NZ */, 554 }, /* New Zealand */
161 { 0x4F4D /* OM */, 512 }, /* Oman */
162 { 0x5041 /* PA */, 591 }, /* Panama */
163 { 0x5045 /* PE */, 604 }, /* Peru */
164 { 0x5048 /* PH */, 608 }, /* Republic of the Philippines */
165 { 0x504B /* PK */, 586 }, /* Islamic Republic of Pakistan */
166 { 0x504C /* PL */, 616 }, /* Poland */
167 { 0x5052 /* PR */, 630 }, /* Puerto Rico */
168 { 0x5054 /* PT */, 620 }, /* Portugal */
169 { 0x5059 /* PY */, 600 }, /* Paraguay */
170 { 0x5141 /* QA */, 634 }, /* Qatar */
171 { 0x524F /* RO */, 642 }, /* Romania */
172 { 0x5255 /* RU */, 643 }, /* Russia */
173 { 0x5341 /* SA */, 682 }, /* Saudi Arabia */
174 { 0x5345 /* SE */, 752 }, /* Sweden */
175 { 0x5347 /* SG */, 702 }, /* Singapore */
176 { 0x5349 /* SI */, 705 }, /* Slovenia */
177 { 0x534B /* SK */, 703 }, /* Slovak Republic */
178 { 0x5356 /* SV */, 222 }, /* El Salvador */
179 { 0x5359 /* SY */, 760 }, /* Syria */
180 { 0x5448 /* TH */, 764 }, /* Thailand */
181 { 0x544E /* TN */, 788 }, /* Tunisia */
182 { 0x5452 /* TR */, 792 }, /* Turkey */
183 { 0x5454 /* TT */, 780 }, /* Trinidad y Tobago */
184 { 0x5457 /* TW */, 158 }, /* Taiwan */
185 { 0x5541 /* UA */, 804 }, /* Ukraine */
186 { 0x554B /* UK */, 826 }, /* United Kingdom */
187 { 0x5553 /* US */, 840 }, /* United States */
188 { 0x5553 /* US */, 842 }, /* United States (Public Safety)*/
189 { 0x5559 /* UY */, 858 }, /* Uruguay */
190 { 0x555A /* UZ */, 860 }, /* Uzbekistan */
191 { 0x5645 /* VE */, 862 }, /* Venezuela */
192 { 0x564E /* VN */, 704 }, /* Viet Nam */
193 { 0x5945 /* YE */, 887 }, /* Yemen */
194 { 0x5A41 /* ZA */, 710 }, /* South Africa */
195 { 0x5A57 /* ZW */, 716 }, /* Zimbabwe */
196 };
197
198
199 static const char * madwifi_phyname(const char *ifname)
200 {
201 static char phyname[IFNAMSIZ];
202
203 if (strlen(ifname) > 5 && !strncmp(ifname, "radio", 5))
204 snprintf(phyname, sizeof(phyname), "wifi%s", ifname + 5);
205 else
206 snprintf(phyname, sizeof(phyname), "%s", ifname);
207
208 return (const char *)phyname;
209 }
210
211 static int madwifi_wrq(struct iwreq *wrq, const char *ifname, int cmd, void *data, size_t len)
212 {
213 strncpy(wrq->ifr_name, ifname, IFNAMSIZ);
214
215 if( data != NULL )
216 {
217 if( len < IFNAMSIZ )
218 {
219 memcpy(wrq->u.name, data, len);
220 }
221 else
222 {
223 wrq->u.data.pointer = data;
224 wrq->u.data.length = len;
225 }
226 }
227
228 return iwinfo_ioctl(cmd, wrq);
229 }
230
231 static int get80211priv(const char *ifname, int op, void *data, size_t len)
232 {
233 struct iwreq iwr;
234
235 if( madwifi_wrq(&iwr, ifname, op, data, len) < 0 )
236 return -1;
237
238 return iwr.u.data.length;
239 }
240
241 static char * madwifi_isvap(const char *ifname, const char *wifiname)
242 {
243 int fd, ln;
244 char path[32];
245 char *ret = NULL;
246 static char name[IFNAMSIZ];
247
248 if( strlen(ifname) <= 9 )
249 {
250 sprintf(path, "/proc/sys/net/%s/%%parent", ifname);
251
252 if( (fd = open(path, O_RDONLY)) > -1 )
253 {
254 if( wifiname != NULL )
255 {
256 if( read(fd, name, strlen(wifiname)) == strlen(wifiname) )
257 ret = strncmp(name, wifiname, strlen(wifiname))
258 ? NULL : name;
259 }
260 else if( (ln = read(fd, name, IFNAMSIZ)) >= 4 )
261 {
262 name[ln-1] = 0;
263 ret = name;
264 }
265
266 (void) close(fd);
267 }
268 }
269
270 return ret;
271 }
272
273 static int madwifi_iswifi(const char *ifname)
274 {
275 int ret;
276 char path[32];
277 struct stat s;
278 const char *phy;
279
280 ret = 0;
281 phy = madwifi_phyname(ifname);
282
283 if( strlen(phy) <= 7 )
284 {
285 sprintf(path, "/proc/sys/dev/%s/diversity", phy);
286
287 if( ! stat(path, &s) )
288 ret = (s.st_mode & S_IFREG);
289 }
290
291 return ret;
292 }
293
294 static char * madwifi_ifadd(const char *ifname)
295 {
296 const char *wifidev = NULL;
297 struct ifreq ifr = { 0 };
298 struct ieee80211_clone_params cp = { 0 };
299 static char nif[IFNAMSIZ] = { 0 };
300
301 if( !(wifidev = madwifi_isvap(ifname, NULL)) && madwifi_iswifi(ifname) )
302 wifidev = madwifi_phyname(ifname);
303
304 if( wifidev )
305 {
306 snprintf(nif, sizeof(nif), "tmp.%s", ifname);
307
308 strncpy(cp.icp_name, nif, IFNAMSIZ);
309 cp.icp_opmode = IEEE80211_M_STA;
310 cp.icp_flags = IEEE80211_CLONE_BSSID;
311
312 strncpy(ifr.ifr_name, wifidev, IFNAMSIZ);
313 ifr.ifr_data = (void *)&cp;
314
315 if( !iwinfo_ioctl(SIOC80211IFCREATE, &ifr) )
316 {
317 return nif;
318 }
319 else
320 {
321 cp.icp_opmode = IEEE80211_M_MONITOR;
322
323 if( !iwinfo_ioctl(SIOC80211IFCREATE, &ifr) )
324 return nif;
325 }
326 }
327
328 return NULL;
329 }
330
331 static void madwifi_ifdel(const char *ifname)
332 {
333 struct ifreq ifr = { 0 };
334
335 strncpy(ifr.ifr_name, ifname, IFNAMSIZ);
336 iwinfo_ioctl(SIOC80211IFDESTROY, &ifr);
337 }
338
339
340 int madwifi_probe(const char *ifname)
341 {
342 return ( !!madwifi_isvap(ifname, NULL) || madwifi_iswifi(ifname) );
343 }
344
345 void madwifi_close(void)
346 {
347 /* Nop */
348 }
349
350 int madwifi_get_mode(const char *ifname, int *buf)
351 {
352 return wext_get_mode(ifname, buf);
353 }
354
355 int madwifi_get_ssid(const char *ifname, char *buf)
356 {
357 return wext_get_ssid(ifname, buf);
358 }
359
360 int madwifi_get_bssid(const char *ifname, char *buf)
361 {
362 return wext_get_bssid(ifname, buf);
363 }
364
365 int madwifi_get_channel(const char *ifname, int *buf)
366 {
367 int i;
368 uint16_t freq;
369 struct iwreq wrq;
370 struct ieee80211req_chaninfo chans;
371
372 if( madwifi_wrq(&wrq, ifname, SIOCGIWFREQ, NULL, 0) >= 0 )
373 {
374 /* Madwifi returns a Hz frequency, get it's freq list to find channel index */
375 freq = (uint16_t)(wrq.u.freq.m / 100000);
376
377 if( get80211priv(ifname, IEEE80211_IOCTL_GETCHANINFO, &chans, sizeof(chans)) >= 0 )
378 {
379 *buf = 0;
380
381 for( i = 0; i < chans.ic_nchans; i++ )
382 {
383 if( freq == chans.ic_chans[i].ic_freq )
384 {
385 *buf = chans.ic_chans[i].ic_ieee;
386 break;
387 }
388 }
389
390 return 0;
391 }
392 }
393
394 return -1;
395 }
396
397 int madwifi_get_frequency(const char *ifname, int *buf)
398 {
399 struct iwreq wrq;
400
401 if( madwifi_wrq(&wrq, ifname, SIOCGIWFREQ, NULL, 0) >= 0 )
402 {
403 *buf = (uint16_t)(wrq.u.freq.m / 100000);
404 return 0;
405 }
406
407 return -1;
408 }
409
410 int madwifi_get_txpower(const char *ifname, int *buf)
411 {
412 return wext_get_txpower(ifname, buf);
413 }
414
415 int madwifi_get_bitrate(const char *ifname, int *buf)
416 {
417 unsigned int mode, len, rate, rate_count;
418 uint8_t tmp[24*1024];
419 uint8_t *cp;
420 struct iwreq wrq;
421 struct ieee80211req_sta_info *si;
422
423 if( madwifi_wrq(&wrq, ifname, SIOCGIWMODE, NULL, 0) >= 0 )
424 {
425 mode = wrq.u.mode;
426
427 /* Calculate bitrate average from associated stations in ad-hoc mode */
428 if( mode == 1 )
429 {
430 rate = rate_count = 0;
431
432 if( (len = get80211priv(ifname, IEEE80211_IOCTL_STA_INFO, tmp, 24*1024)) > 0 )
433 {
434 cp = tmp;
435
436 do {
437 si = (struct ieee80211req_sta_info *) cp;
438
439 if( si->isi_rssi > 0 )
440 {
441 rate_count++;
442 rate += ((si->isi_rates[si->isi_txrate] & IEEE80211_RATE_VAL) / 2);
443 }
444
445 cp += si->isi_len;
446 len -= si->isi_len;
447 } while (len >= sizeof(struct ieee80211req_sta_info));
448 }
449
450 *buf = (rate == 0 || rate_count == 0) ? 0 : (rate / rate_count) * 1000;
451 return 0;
452 }
453
454 /* Return whatever wext tells us ... */
455 return wext_get_bitrate(ifname, buf);
456 }
457
458 return -1;
459 }
460
461 int madwifi_get_signal(const char *ifname, int *buf)
462 {
463 unsigned int mode, len, rssi, rssi_count;
464 uint8_t tmp[24*1024];
465 uint8_t *cp;
466 struct iwreq wrq;
467 struct ieee80211req_sta_info *si;
468
469 if( madwifi_wrq(&wrq, ifname, SIOCGIWMODE, NULL, 0) >= 0 )
470 {
471 mode = wrq.u.mode;
472
473 /* Calculate signal average from associated stations in ap or ad-hoc mode */
474 if( mode == 1 )
475 {
476 rssi = rssi_count = 0;
477
478 if( (len = get80211priv(ifname, IEEE80211_IOCTL_STA_INFO, tmp, 24*1024)) > 0 )
479 {
480 cp = tmp;
481
482 do {
483 si = (struct ieee80211req_sta_info *) cp;
484
485 if( si->isi_rssi > 0 )
486 {
487 rssi_count++;
488 rssi -= (si->isi_rssi - 95);
489 }
490
491 cp += si->isi_len;
492 len -= si->isi_len;
493 } while (len >= sizeof(struct ieee80211req_sta_info));
494 }
495
496 *buf = (rssi == 0 || rssi_count == 0) ? 1 : -(rssi / rssi_count);
497 return 0;
498 }
499
500 /* Return whatever wext tells us ... */
501 return wext_get_signal(ifname, buf);
502 }
503
504 return -1;
505 }
506
507 int madwifi_get_noise(const char *ifname, int *buf)
508 {
509 return wext_get_noise(ifname, buf);
510 }
511
512 int madwifi_get_quality(const char *ifname, int *buf)
513 {
514 unsigned int mode, len, quality, quality_count;
515 uint8_t tmp[24*1024];
516 uint8_t *cp;
517 struct iwreq wrq;
518 struct ieee80211req_sta_info *si;
519
520 if( madwifi_wrq(&wrq, ifname, SIOCGIWMODE, NULL, 0) >= 0 )
521 {
522 mode = wrq.u.mode;
523
524 /* Calculate signal average from associated stations in ad-hoc mode */
525 if( mode == 1 )
526 {
527 quality = quality_count = 0;
528
529 if( (len = get80211priv(ifname, IEEE80211_IOCTL_STA_INFO, tmp, 24*1024)) > 0 )
530 {
531 cp = tmp;
532
533 do {
534 si = (struct ieee80211req_sta_info *) cp;
535
536 if( si->isi_rssi > 0 )
537 {
538 quality_count++;
539 quality += si->isi_rssi;
540 }
541
542 cp += si->isi_len;
543 len -= si->isi_len;
544 } while (len >= sizeof(struct ieee80211req_sta_info));
545 }
546
547 *buf = (quality == 0 || quality_count == 0) ? 0 : (quality / quality_count);
548 return 0;
549 }
550
551 /* Return whatever wext tells us ... */
552 return wext_get_quality(ifname, buf);
553 }
554
555 return -1;
556 }
557
558 int madwifi_get_quality_max(const char *ifname, int *buf)
559 {
560 return wext_get_quality_max(ifname, buf);
561 }
562
563 int madwifi_get_encryption(const char *ifname, char *buf)
564 {
565 int ciphers = 0, key_len = 0;
566 char keybuf[IW_ENCODING_TOKEN_MAX];
567 struct iwinfo_crypto_entry *c = (struct iwinfo_crypto_entry *)buf;
568 struct iwreq wrq;
569 struct ieee80211req_key wk;
570
571 memset(&wrq, 0, sizeof(wrq));
572
573 /* Obtain key info */
574 if( madwifi_wrq(&wrq, ifname, SIOCGIWENCODE, keybuf, sizeof(keybuf)) < 0 )
575 return -1;
576
577 #if 0
578 /* Have any encryption? */
579 if( (wrq.u.data.flags & IW_ENCODE_DISABLED) || (wrq.u.data.length == 0) )
580 return 0;
581 #endif
582
583 /* Save key len */
584 key_len = wrq.u.data.length;
585
586 /* Get wpa protocol version */
587 wrq.u.mode = IEEE80211_PARAM_WPA;
588 if( madwifi_wrq(&wrq, ifname, IEEE80211_IOCTL_GETPARAM, NULL, 0) >= 0 )
589 c->wpa_version = wrq.u.mode;
590
591 /* Get authentication suites */
592 wrq.u.mode = IEEE80211_PARAM_AUTHMODE;
593 if( madwifi_wrq(&wrq, ifname, IEEE80211_IOCTL_GETPARAM, NULL, 0) >= 0 )
594 {
595 switch(wrq.u.mode) {
596 case IEEE80211_AUTH_8021X:
597 c->auth_suites |= IWINFO_KMGMT_8021x;
598 break;
599
600 case IEEE80211_AUTH_WPA:
601 c->auth_suites |= IWINFO_KMGMT_PSK;
602 break;
603
604 case IEEE80211_AUTH_OPEN:
605 c->auth_algs |= IWINFO_AUTH_OPEN;
606 break;
607
608 case IEEE80211_AUTH_SHARED:
609 c->auth_algs |= IWINFO_AUTH_SHARED;
610 break;
611
612 default:
613 c->auth_suites |= IWINFO_KMGMT_NONE;
614 break;
615 }
616 }
617
618 memset(&wk, 0, sizeof(wk));
619 memset(wk.ik_macaddr, 0xff, IEEE80211_ADDR_LEN);
620
621 /* Get key information */
622 if( get80211priv(ifname, IEEE80211_IOCTL_GETKEY, &wk, sizeof(wk)) >= 0 )
623 {
624 /* Type 0 == WEP */
625 if( (wk.ik_type == 0) && (c->auth_algs == 0) )
626 c->auth_algs = (IWINFO_AUTH_OPEN | IWINFO_AUTH_SHARED);
627 }
628
629 /* Get used pairwise ciphers */
630 wrq.u.mode = IEEE80211_PARAM_UCASTCIPHERS;
631 if( madwifi_wrq(&wrq, ifname, IEEE80211_IOCTL_GETPARAM, NULL, 0) >= 0 )
632 {
633 ciphers = wrq.u.mode;
634
635 if( c->wpa_version && ciphers & (1 << IEEE80211_CIPHER_TKIP) )
636 c->pair_ciphers |= IWINFO_CIPHER_TKIP;
637
638 if( c->wpa_version && ciphers & (1 << IEEE80211_CIPHER_AES_CCM) )
639 c->pair_ciphers |= IWINFO_CIPHER_CCMP;
640
641 if( c->wpa_version && ciphers & (1 << IEEE80211_CIPHER_AES_OCB) )
642 c->pair_ciphers |= IWINFO_CIPHER_AESOCB;
643
644 if( c->wpa_version && ciphers & (1 << IEEE80211_CIPHER_CKIP) )
645 c->pair_ciphers |= IWINFO_CIPHER_CKIP;
646
647 if( !c->pair_ciphers && ciphers & (1 << IEEE80211_CIPHER_WEP) )
648 {
649 switch(key_len) {
650 case 13:
651 c->pair_ciphers |= IWINFO_CIPHER_WEP104;
652 break;
653
654 case 5:
655 c->pair_ciphers |= IWINFO_CIPHER_WEP40;
656 break;
657
658 case 0:
659 break;
660
661 default:
662 c->pair_ciphers = IWINFO_CIPHER_WEP40 |
663 IWINFO_CIPHER_WEP104;
664 break;
665 }
666 }
667
668 if( ciphers & (1 << IEEE80211_CIPHER_NONE) )
669 c->pair_ciphers |= IWINFO_CIPHER_NONE;
670 }
671
672 /* Get used group cipher */
673 wrq.u.mode = IEEE80211_PARAM_MCASTCIPHER;
674 if( madwifi_wrq(&wrq, ifname, IEEE80211_IOCTL_GETPARAM, NULL, 0) >= 0 )
675 {
676 ciphers = c->wpa_version ? wrq.u.mode : IEEE80211_CIPHER_WEP;
677
678 switch(ciphers) {
679 case IEEE80211_CIPHER_TKIP:
680 c->group_ciphers |= IWINFO_CIPHER_TKIP;
681 break;
682
683 case IEEE80211_CIPHER_AES_CCM:
684 c->group_ciphers |= IWINFO_CIPHER_CCMP;
685 break;
686
687 case IEEE80211_CIPHER_AES_OCB:
688 c->group_ciphers |= IWINFO_CIPHER_AESOCB;
689 break;
690
691 case IEEE80211_CIPHER_CKIP:
692 c->group_ciphers |= IWINFO_CIPHER_CKIP;
693 break;
694
695 case IEEE80211_CIPHER_WEP:
696 switch(key_len) {
697 case 13:
698 c->group_ciphers |= IWINFO_CIPHER_WEP104;
699 break;
700
701 case 5:
702 c->group_ciphers |= IWINFO_CIPHER_WEP40;
703 break;
704
705 default:
706 break;
707 }
708 break;
709
710 case IEEE80211_CIPHER_NONE:
711 c->group_ciphers |= IWINFO_CIPHER_NONE;
712 break;
713
714 default:
715 break;
716 }
717 }
718
719 c->enabled = (c->wpa_version || (c->auth_algs && c->pair_ciphers)) ? 1 : 0;
720
721 return 0;
722 }
723
724 int madwifi_get_assoclist(const char *ifname, char *buf, int *len)
725 {
726 int bl, tl, noise;
727 uint8_t *cp;
728 uint8_t tmp[24*1024];
729 struct ieee80211req_sta_info *si;
730 struct iwinfo_assoclist_entry entry;
731
732 if( (tl = get80211priv(ifname, IEEE80211_IOCTL_STA_INFO, tmp, 24*1024)) > 0 )
733 {
734 cp = tmp;
735 bl = 0;
736
737 if( madwifi_get_noise(ifname, &noise) )
738 noise = 0;
739
740 do {
741 si = (struct ieee80211req_sta_info *) cp;
742
743 memset(&entry, 0, sizeof(entry));
744
745 entry.signal = (si->isi_rssi - 95);
746 entry.noise = noise;
747 memcpy(entry.mac, &si->isi_macaddr, 6);
748
749 entry.inactive = si->isi_inact * 1000;
750
751 entry.tx_packets = (si->isi_txseqs[0] & IEEE80211_SEQ_SEQ_MASK)
752 >> IEEE80211_SEQ_SEQ_SHIFT;
753
754 entry.rx_packets = (si->isi_rxseqs[0] & IEEE80211_SEQ_SEQ_MASK)
755 >> IEEE80211_SEQ_SEQ_SHIFT;
756
757 entry.tx_rate.rate =
758 (si->isi_rates[si->isi_txrate] & IEEE80211_RATE_VAL) * 500;
759
760 /* XXX: this is just a guess */
761 entry.rx_rate.rate = entry.tx_rate.rate;
762
763 entry.rx_rate.mcs = -1;
764 entry.tx_rate.mcs = -1;
765
766 memcpy(&buf[bl], &entry, sizeof(struct iwinfo_assoclist_entry));
767
768 bl += sizeof(struct iwinfo_assoclist_entry);
769 cp += si->isi_len;
770 tl -= si->isi_len;
771 } while (tl >= sizeof(struct ieee80211req_sta_info));
772
773 *len = bl;
774 return 0;
775 }
776
777 return -1;
778 }
779
780 int madwifi_get_txpwrlist(const char *ifname, char *buf, int *len)
781 {
782 int rc = -1;
783 char *res;
784
785 /* A wifiX device? */
786 if( madwifi_iswifi(ifname) )
787 {
788 if( (res = madwifi_ifadd(ifname)) != NULL )
789 {
790 rc = wext_get_txpwrlist(res, buf, len);
791 madwifi_ifdel(res);
792 }
793 }
794
795 /* Its an athX ... */
796 else if( !!madwifi_isvap(ifname, NULL) )
797 {
798 rc = wext_get_txpwrlist(ifname, buf, len);
799 }
800
801 return rc;
802 }
803
804 int madwifi_get_scanlist(const char *ifname, char *buf, int *len)
805 {
806 int ret;
807 char *res;
808 DIR *proc;
809 struct dirent *e;
810
811 ret = -1;
812
813 /* We got a wifiX device passed, try to lookup a vap on it */
814 if( madwifi_iswifi(ifname) )
815 {
816 if( (proc = opendir("/proc/sys/net/")) != NULL )
817 {
818 while( (e = readdir(proc)) != NULL )
819 {
820 if( !!madwifi_isvap(e->d_name, ifname) )
821 {
822 if( iwinfo_ifup(e->d_name) )
823 {
824 ret = wext_get_scanlist(e->d_name, buf, len);
825 break;
826 }
827 }
828 }
829
830 closedir(proc);
831 }
832
833 /* Still nothing found, try to create a vap */
834 if( ret == -1 )
835 {
836 if( (res = madwifi_ifadd(ifname)) != NULL )
837 {
838 if( iwinfo_ifup(res) )
839 {
840 wext_get_scanlist(res, buf, len);
841 sleep(1);
842
843 wext_get_scanlist(res, buf, len);
844 sleep(1);
845
846 ret = wext_get_scanlist(res, buf, len);
847 }
848
849 iwinfo_ifdown(res);
850 madwifi_ifdel(res);
851 }
852 }
853 }
854
855 /* Got athX device? */
856 else if( !!madwifi_isvap(ifname, NULL) )
857 {
858 ret = wext_get_scanlist(ifname, buf, len);
859 }
860
861 return ret;
862 }
863
864 int madwifi_get_freqlist(const char *ifname, char *buf, int *len)
865 {
866 int i, bl;
867 int rc = -1;
868 char *res;
869 struct ieee80211req_chaninfo chans;
870 struct iwinfo_freqlist_entry entry;
871
872 /* A wifiX device? */
873 if( madwifi_iswifi(ifname) )
874 {
875 if( (res = madwifi_ifadd(ifname)) != NULL )
876 {
877 rc = get80211priv(res, IEEE80211_IOCTL_GETCHANINFO,
878 &chans, sizeof(chans));
879
880 madwifi_ifdel(res);
881 }
882 }
883
884 /* Its an athX ... */
885 else if( !!madwifi_isvap(ifname, NULL) )
886 {
887 rc = get80211priv(ifname, IEEE80211_IOCTL_GETCHANINFO,
888 &chans, sizeof(chans));
889 }
890
891
892 /* Got chaninfo? */
893 if( rc >= 0 )
894 {
895 bl = 0;
896
897 for( i = 0; i < chans.ic_nchans; i++ )
898 {
899 entry.mhz = chans.ic_chans[i].ic_freq;
900 entry.channel = chans.ic_chans[i].ic_ieee;
901 entry.restricted = 0;
902
903 memcpy(&buf[bl], &entry, sizeof(struct iwinfo_freqlist_entry));
904 bl += sizeof(struct iwinfo_freqlist_entry);
905 }
906
907 *len = bl;
908 return 0;
909 }
910
911 return -1;
912 }
913
914 int madwifi_get_country(const char *ifname, char *buf)
915 {
916 int i, fd, ccode = -1;
917 char buffer[34];
918 char *wifi = madwifi_iswifi(ifname)
919 ? (char *)ifname : madwifi_isvap(ifname, NULL);
920
921 struct ISO3166_to_CCode *e;
922
923 if( wifi )
924 {
925 snprintf(buffer, sizeof(buffer), "/proc/sys/dev/%s/countrycode", wifi);
926
927 if( (fd = open(buffer, O_RDONLY)) > -1 )
928 {
929 memset(buffer, 0, sizeof(buffer));
930
931 if( read(fd, buffer, sizeof(buffer)-1) > 0 )
932 ccode = atoi(buffer);
933
934 close(fd);
935 }
936 }
937
938 for( i = 0; i < (sizeof(CountryCodes)/sizeof(CountryCodes[0])); i++ )
939 {
940 e = &CountryCodes[i];
941
942 if( e->ccode == ccode )
943 {
944 sprintf(buf, "%c%c", e->iso3166 / 256, e->iso3166 % 256);
945 return 0;
946 }
947 }
948
949 return -1;
950 }
951
952 int madwifi_get_countrylist(const char *ifname, char *buf, int *len)
953 {
954 int i, count;
955 struct ISO3166_to_CCode *e, *p = NULL;
956 struct iwinfo_country_entry *c = (struct iwinfo_country_entry *)buf;
957
958 count = 0;
959
960 for( int i = 0; i < (sizeof(CountryCodes)/sizeof(CountryCodes[0])); i++ )
961 {
962 e = &CountryCodes[i];
963
964 if( !p || (e->iso3166 != p->iso3166) )
965 {
966 c->iso3166 = e->iso3166;
967 snprintf(c->ccode, sizeof(c->ccode), "%i", e->ccode);
968
969 c++;
970 count++;
971 }
972
973 p = e;
974 }
975
976 *len = (count * sizeof(struct iwinfo_country_entry));
977 return 0;
978 }
979
980 int madwifi_get_hwmodelist(const char *ifname, int *buf)
981 {
982 char chans[IWINFO_BUFSIZE] = { 0 };
983 struct iwinfo_freqlist_entry *e = NULL;
984 int len = 0;
985
986 if( !madwifi_get_freqlist(ifname, chans, &len) )
987 {
988 for( e = (struct iwinfo_freqlist_entry *)chans; e->channel; e++ )
989 {
990 if( e->channel <= 14 )
991 {
992 *buf |= IWINFO_80211_B;
993 *buf |= IWINFO_80211_G;
994 }
995 else
996 {
997 *buf |= IWINFO_80211_A;
998 }
999 }
1000
1001 return 0;
1002 }
1003
1004 return -1;
1005 }
1006
1007 int madwifi_get_mbssid_support(const char *ifname, int *buf)
1008 {
1009 /* Test whether we can create another interface */
1010 char *nif = madwifi_ifadd(ifname);
1011
1012 if( nif )
1013 {
1014 *buf = iwinfo_ifup(nif);
1015
1016 iwinfo_ifdown(nif);
1017 madwifi_ifdel(nif);
1018
1019 return 0;
1020 }
1021
1022 return -1;
1023 }
1024
1025 int madwifi_get_hardware_id(const char *ifname, char *buf)
1026 {
1027 char vendor[64];
1028 char device[64];
1029 struct iwinfo_hardware_id *ids;
1030 struct iwinfo_hardware_entry *e;
1031 const char *phy = madwifi_phyname(ifname);
1032
1033 if (wext_get_hardware_id(phy, buf))
1034 return iwinfo_hardware_id_from_mtd((struct iwinfo_hardware_id *)buf);
1035
1036 return 0;
1037 }
1038
1039 static const struct iwinfo_hardware_entry *
1040 madwifi_get_hardware_entry(const char *ifname)
1041 {
1042 struct iwinfo_hardware_id id;
1043
1044 if (madwifi_get_hardware_id(ifname, (char *)&id))
1045 return NULL;
1046
1047 return iwinfo_hardware(&id);
1048 }
1049
1050 int madwifi_get_hardware_name(const char *ifname, char *buf)
1051 {
1052 const struct iwinfo_hardware_entry *hw;
1053
1054 if (!(hw = madwifi_get_hardware_entry(ifname)))
1055 sprintf(buf, "Generic Atheros");
1056 else
1057 sprintf(buf, "%s %s", hw->vendor_name, hw->device_name);
1058
1059 return 0;
1060 }
1061
1062 int madwifi_get_txpower_offset(const char *ifname, int *buf)
1063 {
1064 const struct iwinfo_hardware_entry *hw;
1065
1066 if (!(hw = madwifi_get_hardware_entry(ifname)))
1067 return -1;
1068
1069 *buf = hw->txpower_offset;
1070 return 0;
1071 }
1072
1073 int madwifi_get_frequency_offset(const char *ifname, int *buf)
1074 {
1075 const struct iwinfo_hardware_entry *hw;
1076
1077 if (!(hw = madwifi_get_hardware_entry(ifname)))
1078 return -1;
1079
1080 *buf = hw->frequency_offset;
1081 return 0;
1082 }
Staging tree of Stijn Tintel