contrib/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 int madwifi_wrq(struct iwreq *wrq, const char *ifname, int cmd, void *data, size_t len)
 200 {
 201         strncpy(wrq->ifr_name, ifname, IFNAMSIZ);
 202
 203         if( data != NULL )
 204         {
 205                 if( len < IFNAMSIZ )
 206                 {
 207                         memcpy(wrq->u.name, data, len);
 208                 }
 209                 else
 210                 {
 211                         wrq->u.data.pointer = data;
 212                         wrq->u.data.length = len;
 213                 }
 214         }
 215
 216         return iwinfo_ioctl(cmd, wrq);
 217 }
 218
 219 static int get80211priv(const char *ifname, int op, void *data, size_t len)
 220 {
 221         struct iwreq iwr;
 222
 223         if( madwifi_wrq(&iwr, ifname, op, data, len) < 0 )
 224                 return -1;
 225
 226         return iwr.u.data.length;
 227 }
 228
 229 static char * madwifi_isvap(const char *ifname, const char *wifiname)
 230 {
 231         int fd, ln;
 232         char path[32];
 233         char *ret = NULL;
 234         static char name[IFNAMSIZ];
 235
 236         if( strlen(ifname) <= 9 )
 237         {
 238                 sprintf(path, "/proc/sys/net/%s/%%parent", ifname);
 239
 240                 if( (fd = open(path, O_RDONLY)) > -1 )
 241                 {
 242                         if( wifiname != NULL )
 243                         {
 244                                 if( read(fd, name, strlen(wifiname)) == strlen(wifiname) )
 245                                         ret = strncmp(name, wifiname, strlen(wifiname))
 246                                                 ? NULL : name;
 247                         }
 248                         else if( (ln = read(fd, name, IFNAMSIZ)) >= 4 )
 249                         {
 250                                 name[ln-1] = 0;
 251                                 ret = name;
 252                         }
 253
 254                         (void) close(fd);
 255                 }
 256         }
 257
 258         return ret;
 259 }
 260
 261 static int madwifi_iswifi(const char *ifname)
 262 {
 263         int ret;
 264         char path[32];
 265         struct stat s;
 266
 267         ret = 0;
 268
 269         if( strlen(ifname) <= 7 )
 270         {
 271                 sprintf(path, "/proc/sys/dev/%s/diversity", ifname);
 272
 273                 if( ! stat(path, &s) )
 274                         ret = (s.st_mode & S_IFREG);
 275         }
 276
 277         return ret;
 278 }
 279
 280 static char * madwifi_ifadd(const char *ifname)
 281 {
 282         char *wifidev = NULL;
 283         struct ifreq ifr = { 0 };
 284         struct ieee80211_clone_params cp = { 0 };
 285         static char nif[IFNAMSIZ] = { 0 };
 286
 287         if( !(wifidev = madwifi_isvap(ifname, NULL)) && madwifi_iswifi(ifname) )
 288                 wifidev = (char *)ifname;
 289
 290         if( wifidev )
 291         {
 292                 snprintf(nif, sizeof(nif), "tmp.%s", ifname);
 293
 294                 strncpy(cp.icp_name, nif, IFNAMSIZ);
 295                 cp.icp_opmode = IEEE80211_M_MONITOR;
 296                 cp.icp_flags  = IEEE80211_CLONE_BSSID;
 297
 298                 strncpy(ifr.ifr_name, wifidev, IFNAMSIZ);
 299                 ifr.ifr_data  = (void *)&cp;
 300
 301                 if( !iwinfo_ioctl(SIOC80211IFCREATE, &ifr) )
 302                         return nif;
 303         }
 304
 305         return NULL;
 306 }
 307
 308 static void madwifi_ifdel(const char *ifname)
 309 {
 310         struct ifreq ifr = { 0 };
 311
 312         strncpy(ifr.ifr_name, ifname, IFNAMSIZ);
 313         iwinfo_ioctl(SIOC80211IFDESTROY, &ifr);
 314 }
 315
 316
 317 int madwifi_probe(const char *ifname)
 318 {
 319         return ( !!madwifi_isvap(ifname, NULL) || madwifi_iswifi(ifname) );
 320 }
 321
 322 void madwifi_close(void)
 323 {
 324         /* Nop */
 325 }
 326
 327 int madwifi_get_mode(const char *ifname, char *buf)
 328 {
 329         return wext_get_mode(ifname, buf);
 330 }
 331
 332 int madwifi_get_ssid(const char *ifname, char *buf)
 333 {
 334         return wext_get_ssid(ifname, buf);
 335 }
 336
 337 int madwifi_get_bssid(const char *ifname, char *buf)
 338 {
 339         return wext_get_bssid(ifname, buf);
 340 }
 341
 342 int madwifi_get_channel(const char *ifname, int *buf)
 343 {
 344         int i;
 345         uint16_t freq;
 346         struct iwreq wrq;
 347         struct ieee80211req_chaninfo chans;
 348
 349         if( madwifi_wrq(&wrq, ifname, SIOCGIWFREQ, NULL, 0) >= 0 )
 350         {
 351                 /* Madwifi returns a Hz frequency, get it's freq list to find channel index */
 352                 freq = (uint16_t)(wrq.u.freq.m / 100000);
 353
 354                 if( get80211priv(ifname, IEEE80211_IOCTL_GETCHANINFO, &chans, sizeof(chans)) >= 0 )
 355                 {
 356                         *buf = 0;
 357
 358                         for( i = 0; i < chans.ic_nchans; i++ )
 359                         {
 360                                 if( freq == chans.ic_chans[i].ic_freq )
 361                                 {
 362                                         *buf = chans.ic_chans[i].ic_ieee;
 363                                         break;
 364                                 }
 365                         }
 366
 367                         return 0;
 368                 }
 369         }
 370
 371         return -1;
 372 }
 373
 374 int madwifi_get_frequency(const char *ifname, int *buf)
 375 {
 376         struct iwreq wrq;
 377
 378         if( madwifi_wrq(&wrq, ifname, SIOCGIWFREQ, NULL, 0) >= 0 )
 379         {
 380                 *buf = (uint16_t)(wrq.u.freq.m / 100000);
 381                 return 0;
 382         }
 383
 384         return -1;
 385 }
 386
 387 int madwifi_get_txpower(const char *ifname, int *buf)
 388 {
 389         return wext_get_txpower(ifname, buf);
 390 }
 391
 392 int madwifi_get_bitrate(const char *ifname, int *buf)
 393 {
 394         unsigned int mode, len, rate, rate_count;
 395         uint8_t tmp[24*1024];
 396         uint8_t *cp;
 397         struct iwreq wrq;
 398         struct ieee80211req_sta_info *si;
 399
 400         if( madwifi_wrq(&wrq, ifname, SIOCGIWMODE, NULL, 0) >= 0 )
 401         {
 402                 mode = wrq.u.mode;
 403
 404                 /* Calculate bitrate average from associated stations in ad-hoc mode */
 405                 if( mode == 1 )
 406                 {
 407                         rate = rate_count = 0;
 408
 409                         if( (len = get80211priv(ifname, IEEE80211_IOCTL_STA_INFO, tmp, 24*1024)) > 0 )
 410                         {
 411                                 cp = tmp;
 412
 413                                 do {
 414                                         si = (struct ieee80211req_sta_info *) cp;
 415
 416                                         if( si->isi_rssi > 0 )
 417                                         {
 418                                                 rate_count++;
 419                                                 rate += ((si->isi_rates[si->isi_txrate] & IEEE80211_RATE_VAL) / 2);
 420                                         }
 421
 422                                         cp   += si->isi_len;
 423                                         len  -= si->isi_len;
 424                                 } while (len >= sizeof(struct ieee80211req_sta_info));
 425                         }
 426
 427                         *buf = (rate == 0 || rate_count == 0) ? 0 : (rate / rate_count) * 1000;
 428                         return 0;
 429                 }
 430
 431                 /* Return whatever wext tells us ... */
 432                 return wext_get_bitrate(ifname, buf);
 433         }
 434
 435         return -1;
 436 }
 437
 438 int madwifi_get_signal(const char *ifname, int *buf)
 439 {
 440         unsigned int mode, len, rssi, rssi_count;
 441         uint8_t tmp[24*1024];
 442         uint8_t *cp;
 443         struct iwreq wrq;
 444         struct ieee80211req_sta_info *si;
 445
 446         if( madwifi_wrq(&wrq, ifname, SIOCGIWMODE, NULL, 0) >= 0 )
 447         {
 448                 mode = wrq.u.mode;
 449
 450                 /* Calculate signal average from associated stations in ap or ad-hoc mode */
 451                 if( mode == 1 )
 452                 {
 453                         rssi = rssi_count = 0;
 454
 455                         if( (len = get80211priv(ifname, IEEE80211_IOCTL_STA_INFO, tmp, 24*1024)) > 0 )
 456                         {
 457                                 cp = tmp;
 458
 459                                 do {
 460                                         si = (struct ieee80211req_sta_info *) cp;
 461
 462                                         if( si->isi_rssi > 0 )
 463                                         {
 464                                                 rssi_count++;
 465                                                 rssi -= (si->isi_rssi - 95);
 466                                         }
 467
 468                                         cp   += si->isi_len;
 469                                         len  -= si->isi_len;
 470                                 } while (len >= sizeof(struct ieee80211req_sta_info));
 471                         }
 472
 473                         *buf = (rssi == 0 || rssi_count == 0) ? 1 : -(rssi / rssi_count);
 474                         return 0;
 475                 }
 476
 477                 /* Return whatever wext tells us ... */
 478                 return wext_get_signal(ifname, buf);
 479         }
 480
 481         return -1;
 482 }
 483
 484 int madwifi_get_noise(const char *ifname, int *buf)
 485 {
 486         return wext_get_noise(ifname, buf);
 487 }
 488
 489 int madwifi_get_quality(const char *ifname, int *buf)
 490 {
 491         unsigned int mode, len, quality, quality_count;
 492         uint8_t tmp[24*1024];
 493         uint8_t *cp;
 494         struct iwreq wrq;
 495         struct ieee80211req_sta_info *si;
 496
 497         if( madwifi_wrq(&wrq, ifname, SIOCGIWMODE, NULL, 0) >= 0 )
 498         {
 499                 mode = wrq.u.mode;
 500
 501                 /* Calculate signal average from associated stations in ad-hoc mode */
 502                 if( mode == 1 )
 503                 {
 504                         quality = quality_count = 0;
 505
 506                         if( (len = get80211priv(ifname, IEEE80211_IOCTL_STA_INFO, tmp, 24*1024)) > 0 )
 507                         {
 508                                 cp = tmp;
 509
 510                                 do {
 511                                         si = (struct ieee80211req_sta_info *) cp;
 512
 513                                         if( si->isi_rssi > 0 )
 514                                         {
 515                                                 quality_count++;
 516                                                 quality += si->isi_rssi;
 517                                         }
 518
 519                                         cp   += si->isi_len;
 520                                         len  -= si->isi_len;
 521                                 } while (len >= sizeof(struct ieee80211req_sta_info));
 522                         }
 523
 524                         *buf = (quality == 0 || quality_count == 0) ? 0 : (quality / quality_count);
 525                         return 0;
 526                 }
 527
 528                 /* Return whatever wext tells us ... */
 529                 return wext_get_quality(ifname, buf);
 530         }
 531
 532         return -1;
 533 }
 534
 535 int madwifi_get_quality_max(const char *ifname, int *buf)
 536 {
 537         return wext_get_quality_max(ifname, buf);
 538 }
 539
 540 int madwifi_get_encryption(const char *ifname, char *buf)
 541 {
 542         int ciphers = 0, key_len = 0;
 543         struct iwinfo_crypto_entry *c = (struct iwinfo_crypto_entry *)buf;
 544         struct iwreq wrq;
 545         struct ieee80211req_key wk;
 546
 547         memset(&wrq, 0, sizeof(wrq));
 548         memset(&wk, 0, sizeof(wk));
 549         memset(wk.ik_macaddr, 0xff, IEEE80211_ADDR_LEN);
 550
 551         /* Get wpa protocol version */
 552         wrq.u.mode = IEEE80211_PARAM_WPA;
 553         if( madwifi_wrq(&wrq, ifname, IEEE80211_IOCTL_GETPARAM, NULL, 0) >= 0 )
 554                 c->wpa_version = wrq.u.mode;
 555
 556         /* Get authentication suites */
 557         wrq.u.mode = IEEE80211_PARAM_AUTHMODE;
 558         if( madwifi_wrq(&wrq, ifname, IEEE80211_IOCTL_GETPARAM, NULL, 0) >= 0 )
 559         {
 560                 switch(wrq.u.mode) {
 561                         case IEEE80211_AUTH_8021X:
 562                                 c->auth_suites |= IWINFO_KMGMT_8021x;
 563                                 break;
 564
 565                         case IEEE80211_AUTH_WPA:
 566                                 c->auth_suites |= IWINFO_KMGMT_PSK;
 567                                 break;
 568
 569                         case IEEE80211_AUTH_OPEN:
 570                                 c->auth_algs |= IWINFO_AUTH_OPEN;
 571                                 break;
 572
 573                         case IEEE80211_AUTH_SHARED:
 574                                 c->auth_algs |= IWINFO_AUTH_SHARED;
 575                                 break;
 576
 577                         default:
 578                                 c->auth_suites |= IWINFO_KMGMT_NONE;
 579                                 break;
 580                 }
 581         }
 582
 583         /* Get key information */
 584         if( get80211priv(ifname, IEEE80211_IOCTL_GETKEY, &wk, sizeof(wk)) >= 0 )
 585         {
 586                 /* Type 0 == WEP */
 587                 if( (wk.ik_type == 0) && (c->auth_algs == 0) )
 588                         c->auth_algs = (IWINFO_AUTH_OPEN | IWINFO_AUTH_SHARED);
 589         }
 590
 591         /* Get group key length */
 592         wrq.u.mode = IEEE80211_PARAM_MCASTKEYLEN;
 593         if( madwifi_wrq(&wrq, ifname, IEEE80211_IOCTL_GETPARAM, NULL, 0) >= 0 )
 594                 key_len = wrq.u.mode;
 595
 596         /* Get used pairwise ciphers */
 597         wrq.u.mode = IEEE80211_PARAM_UCASTCIPHERS;
 598         if( madwifi_wrq(&wrq, ifname, IEEE80211_IOCTL_GETPARAM, NULL, 0) >= 0 )
 599         {
 600                 ciphers = wrq.u.mode;
 601
 602                 if( ciphers & (1 << IEEE80211_CIPHER_TKIP) )
 603                         c->pair_ciphers |= IWINFO_CIPHER_TKIP;
 604
 605                 if( ciphers & (1 << IEEE80211_CIPHER_AES_CCM) )
 606                         c->pair_ciphers |= IWINFO_CIPHER_CCMP;
 607
 608                 if( ciphers & (1 << IEEE80211_CIPHER_AES_OCB) )
 609                         c->pair_ciphers |= IWINFO_CIPHER_AESOCB;
 610
 611                 if( ciphers & (1 << IEEE80211_CIPHER_CKIP) )
 612                         c->pair_ciphers |= IWINFO_CIPHER_CKIP;
 613
 614                 if( ciphers & (1 << IEEE80211_CIPHER_WEP) )
 615                 {
 616                         switch(key_len) {
 617                                 case 13:
 618                                         c->pair_ciphers |= IWINFO_CIPHER_WEP104;
 619                                         break;
 620
 621                                 case 5:
 622                                         c->pair_ciphers |= IWINFO_CIPHER_WEP40;
 623                                         break;
 624
 625                                 default:
 626                                         break;
 627                         }
 628                 }
 629
 630                 if( ciphers & (1 << IEEE80211_CIPHER_NONE) )
 631                         c->pair_ciphers |= IWINFO_CIPHER_NONE;
 632         }
 633
 634         /* Get used group cipher */
 635         wrq.u.mode = IEEE80211_PARAM_MCASTCIPHER;
 636         if( madwifi_wrq(&wrq, ifname, IEEE80211_IOCTL_GETPARAM, NULL, 0) >= 0 )
 637         {
 638                 ciphers = wrq.u.mode;
 639
 640                 switch(wrq.u.mode) {
 641                         case IEEE80211_CIPHER_TKIP:
 642                                 c->group_ciphers |= IWINFO_CIPHER_TKIP;
 643                                 break;
 644
 645                         case IEEE80211_CIPHER_AES_CCM:
 646                                 c->group_ciphers |= IWINFO_CIPHER_CCMP;
 647                                 break;
 648
 649                         case IEEE80211_CIPHER_AES_OCB:
 650                                 c->group_ciphers |= IWINFO_CIPHER_AESOCB;
 651                                 break;
 652
 653                         case IEEE80211_CIPHER_CKIP:
 654                                 c->group_ciphers |= IWINFO_CIPHER_CKIP;
 655                                 break;
 656
 657                         case IEEE80211_CIPHER_WEP:
 658                                 switch(key_len) {
 659                                         case 13:
 660                                                 c->group_ciphers |= IWINFO_CIPHER_WEP104;
 661                                                 break;
 662
 663                                         case 5:
 664                                                 c->group_ciphers |= IWINFO_CIPHER_WEP40;
 665                                                 break;
 666
 667                                         default:
 668                                                 break;
 669                                 }
 670                                 break;
 671
 672                         case IEEE80211_CIPHER_NONE:
 673                                 c->group_ciphers |= IWINFO_CIPHER_NONE;
 674                                 break;
 675
 676                         default:
 677                                 break;
 678                 }
 679         }
 680
 681         c->enabled = (c->wpa_version || c->auth_algs) ? 1 : 0;
 682
 683         return 0;
 684 }
 685
 686 int madwifi_get_assoclist(const char *ifname, char *buf, int *len)
 687 {
 688         int bl, tl, noise;
 689         uint8_t *cp;
 690         uint8_t tmp[24*1024];
 691         struct ieee80211req_sta_info *si;
 692         struct iwinfo_assoclist_entry entry;
 693
 694         if( (tl = get80211priv(ifname, IEEE80211_IOCTL_STA_INFO, tmp, 24*1024)) > 0 )
 695         {
 696                 cp = tmp;
 697                 bl = 0;
 698
 699                 if( madwifi_get_noise(ifname, &noise) )
 700                         noise = 0;
 701
 702                 do {
 703                         si = (struct ieee80211req_sta_info *) cp;
 704
 705                         entry.signal = (si->isi_rssi - 95);
 706                         entry.noise  = noise;
 707                         memcpy(entry.mac, &si->isi_macaddr, 6);
 708                         memcpy(&buf[bl], &entry, sizeof(struct iwinfo_assoclist_entry));
 709
 710                         bl += sizeof(struct iwinfo_assoclist_entry);
 711                         cp += si->isi_len;
 712                         tl -= si->isi_len;
 713                 } while (tl >= sizeof(struct ieee80211req_sta_info));
 714
 715                 *len = bl;
 716                 return 0;
 717         }
 718
 719         return -1;
 720 }
 721
 722 int madwifi_get_txpwrlist(const char *ifname, char *buf, int *len)
 723 {
 724         int rc = -1;
 725         char *res;
 726
 727         /* A wifiX device? */
 728         if( madwifi_iswifi(ifname) )
 729         {
 730                 if( (res = madwifi_ifadd(ifname)) != NULL )
 731                 {
 732                         rc = wext_get_txpwrlist(res, buf, len);
 733                         madwifi_ifdel(res);
 734                 }
 735         }
 736
 737         /* Its an athX ... */
 738         else if( !!madwifi_isvap(ifname, NULL) )
 739         {
 740                 rc = wext_get_txpwrlist(ifname, buf, len);
 741         }
 742
 743         return rc;
 744 }
 745
 746 int madwifi_get_scanlist(const char *ifname, char *buf, int *len)
 747 {
 748         int ret;
 749         char *res;
 750         DIR *proc;
 751         struct dirent *e;
 752
 753         ret = -1;
 754
 755         /* We got a wifiX device passed, try to lookup a vap on it */
 756         if( madwifi_iswifi(ifname) )
 757         {
 758                 if( (proc = opendir("/proc/sys/net/")) != NULL )
 759                 {
 760                         while( (e = readdir(proc)) != NULL )
 761                         {
 762                                 if( !!madwifi_isvap(e->d_name, ifname) )
 763                                 {
 764                                         if( iwinfo_ifup(e->d_name) )
 765                                         {
 766                                                 ret = wext_get_scanlist(e->d_name, buf, len);
 767                                                 break;
 768                                         }
 769                                 }
 770                         }
 771
 772                         closedir(proc);
 773                 }
 774
 775                 /* Still nothing found, try to create a vap */
 776                 if( ret == -1 )
 777                 {
 778                         if( (res = madwifi_ifadd(ifname)) != NULL )
 779                         {
 780                                 if( iwinfo_ifup(res) )
 781                                         ret = wext_get_scanlist(res, buf, len);
 782
 783                                 iwinfo_ifdown(res);
 784                                 madwifi_ifdel(res);
 785                         }
 786                 }
 787         }
 788
 789         /* Got athX device? */
 790         else if( !!madwifi_isvap(ifname, NULL) )
 791         {
 792                 ret = wext_get_scanlist(ifname, buf, len);
 793         }
 794
 795         return ret;
 796 }
 797
 798 int madwifi_get_freqlist(const char *ifname, char *buf, int *len)
 799 {
 800         int i, bl;
 801         int rc = -1;
 802         char *res;
 803         struct ieee80211req_chaninfo chans;
 804         struct iwinfo_freqlist_entry entry;
 805
 806         /* A wifiX device? */
 807         if( madwifi_iswifi(ifname) )
 808         {
 809                 if( (res = madwifi_ifadd(ifname)) != NULL )
 810                 {
 811                         rc = get80211priv(res, IEEE80211_IOCTL_GETCHANINFO,
 812                                                           &chans, sizeof(chans));
 813
 814                         madwifi_ifdel(res);
 815                 }
 816         }
 817
 818         /* Its an athX ... */
 819         else if( !!madwifi_isvap(ifname, NULL) )
 820         {
 821                 rc = get80211priv(ifname, IEEE80211_IOCTL_GETCHANINFO,
 822                                                   &chans, sizeof(chans));
 823         }
 824
 825
 826         /* Got chaninfo? */
 827         if( rc >= 0 )
 828         {
 829                 bl = 0;
 830
 831                 for( i = 0; i < chans.ic_nchans; i++ )
 832                 {
 833                         entry.mhz        = chans.ic_chans[i].ic_freq;
 834                         entry.channel    = chans.ic_chans[i].ic_ieee;
 835                         entry.restricted = 0;
 836
 837                         memcpy(&buf[bl], &entry, sizeof(struct iwinfo_freqlist_entry));
 838                         bl += sizeof(struct iwinfo_freqlist_entry);
 839                 }
 840
 841                 *len = bl;
 842                 return 0;
 843         }
 844
 845         return -1;
 846 }
 847
 848 int madwifi_get_country(const char *ifname, char *buf)
 849 {
 850         int i, fd, ccode = -1;
 851         char buffer[34];
 852         char *wifi = madwifi_iswifi(ifname)
 853                 ? (char *)ifname : madwifi_isvap(ifname, NULL);
 854
 855         struct ISO3166_to_CCode *e;
 856
 857         if( wifi )
 858         {
 859                 snprintf(buffer, sizeof(buffer), "/proc/sys/dev/%s/countrycode", wifi);
 860
 861                 if( (fd = open(buffer, O_RDONLY)) > -1 )
 862                 {
 863                         memset(buffer, 0, sizeof(buffer));
 864
 865                         if( read(fd, buffer, sizeof(buffer)-1) > 0 )
 866                                 ccode = atoi(buffer);
 867
 868                         close(fd);
 869                 }
 870         }
 871
 872         for( i = 0; i < (sizeof(CountryCodes)/sizeof(CountryCodes[0])); i++ )
 873         {
 874                 e = &CountryCodes[i];
 875
 876                 if( e->ccode == ccode )
 877                 {
 878                         sprintf(buf, "%c%c", e->iso3166 / 256, e->iso3166 % 256);
 879                         return 0;
 880                 }
 881         }
 882
 883         return -1;
 884 }
 885
 886 int madwifi_get_countrylist(const char *ifname, char *buf, int *len)
 887 {
 888         int i, count;
 889         struct ISO3166_to_CCode *e, *p = NULL;
 890         struct iwinfo_country_entry *c = (struct iwinfo_country_entry *)buf;
 891
 892         count = 0;
 893
 894         for( int i = 0; i < (sizeof(CountryCodes)/sizeof(CountryCodes[0])); i++ )
 895         {
 896                 e = &CountryCodes[i];
 897
 898                 if( !p || (e->iso3166 != p->iso3166) )
 899                 {
 900                         c->iso3166 = e->iso3166;
 901                         snprintf(c->ccode, sizeof(c->ccode), "%i", e->ccode);
 902
 903                         c++;
 904                         count++;
 905                 }
 906
 907                 p = e;
 908         }
 909
 910         *len = (count * sizeof(struct iwinfo_country_entry));
 911         return 0;
 912 }
 913
 914 int madwifi_get_hwmodelist(const char *ifname, int *buf)
 915 {
 916         char chans[IWINFO_BUFSIZE] = { 0 };
 917         struct iwinfo_freqlist_entry *e = NULL;
 918         int len = 0;
 919
 920         if( !madwifi_get_freqlist(ifname, chans, &len) )
 921         {
 922                 for( e = (struct iwinfo_freqlist_entry *)chans; e->channel; e++ )
 923                 {
 924                         if( e->channel <= 14 )
 925                         {
 926                                 *buf |= IWINFO_80211_B;
 927                                 *buf |= IWINFO_80211_G;
 928                         }
 929                         else
 930                         {
 931                                 *buf |= IWINFO_80211_A;
 932                         }
 933                 }
 934
 935                 return 0;
 936         }
 937
 938         return -1;
 939 }
 940
 941 int madwifi_get_mbssid_support(const char *ifname, int *buf)
 942 {
 943         /* Test whether we can create another interface */
 944         char *nif = madwifi_ifadd(ifname);
 945
 946         if( nif )
 947         {
 948                 *buf = iwinfo_ifup(nif);
 949
 950                 iwinfo_ifdown(nif);
 951                 madwifi_ifdel(nif);
 952
 953                 return 0;
 954         }
 955
 956         return -1;
 957 }