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_type = 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 key information */
 552         if( get80211priv(ifname, IEEE80211_IOCTL_GETKEY, &wk, sizeof(wk)) >= 0 )
 553         {
 554                 key_type = wk.ik_type;
 555
 556                 /* Type 0 == WEP */
 557                 if( key_type == 0 )
 558                         c->auth_algs = (IWINFO_AUTH_OPEN | IWINFO_AUTH_SHARED);
 559         }
 560
 561         /* Get wpa protocol version */
 562         wrq.u.mode = IEEE80211_PARAM_WPA;
 563         if( madwifi_wrq(&wrq, ifname, IEEE80211_IOCTL_GETPARAM, NULL, 0) >= 0 )
 564                 c->wpa_version = wrq.u.mode;
 565
 566         /* Get authentication suites */
 567         wrq.u.mode = IEEE80211_PARAM_AUTHMODE;
 568         if( madwifi_wrq(&wrq, ifname, IEEE80211_IOCTL_GETPARAM, NULL, 0) >= 0 )
 569         {
 570                 switch(wrq.u.mode) {
 571                         case IEEE80211_AUTH_8021X:
 572                                 c->auth_suites |= IWINFO_KMGMT_8021x;
 573                                 break;
 574
 575                         case IEEE80211_AUTH_WPA:
 576                                 c->auth_suites |= IWINFO_KMGMT_PSK;
 577                                 break;
 578
 579                         default:
 580                                 c->auth_suites |= IWINFO_KMGMT_NONE;
 581                                 break;
 582                 }
 583         }
 584
 585         /* Get group key length */
 586         wrq.u.mode = IEEE80211_PARAM_MCASTKEYLEN;
 587         if( madwifi_wrq(&wrq, ifname, IEEE80211_IOCTL_GETPARAM, NULL, 0) >= 0 )
 588                 key_len = wrq.u.mode;
 589
 590         /* Get used pairwise ciphers */
 591         wrq.u.mode = IEEE80211_PARAM_UCASTCIPHERS;
 592         if( madwifi_wrq(&wrq, ifname, IEEE80211_IOCTL_GETPARAM, NULL, 0) >= 0 )
 593         {
 594                 ciphers = wrq.u.mode;
 595
 596                 if( ciphers & (1 << IEEE80211_CIPHER_TKIP) )
 597                         c->pair_ciphers |= IWINFO_CIPHER_TKIP;
 598
 599                 if( ciphers & (1 << IEEE80211_CIPHER_AES_CCM) )
 600                         c->pair_ciphers |= IWINFO_CIPHER_CCMP;
 601
 602                 if( ciphers & (1 << IEEE80211_CIPHER_AES_OCB) )
 603                         c->pair_ciphers |= IWINFO_CIPHER_AESOCB;
 604
 605                 if( ciphers & (1 << IEEE80211_CIPHER_CKIP) )
 606                         c->pair_ciphers |= IWINFO_CIPHER_CKIP;
 607
 608                 if( ciphers & (1 << IEEE80211_CIPHER_WEP) )
 609                 {
 610                         switch(key_len) {
 611                                 case 13:
 612                                         c->pair_ciphers |= IWINFO_CIPHER_WEP104;
 613                                         break;
 614
 615                                 case 5:
 616                                         c->pair_ciphers |= IWINFO_CIPHER_WEP40;
 617                                         break;
 618
 619                                 default:
 620                                         break;
 621                         }
 622                 }
 623
 624                 if( ciphers & (1 << IEEE80211_CIPHER_NONE) )
 625                         c->pair_ciphers |= IWINFO_CIPHER_NONE;
 626         }
 627
 628         /* Get used group cipher */
 629         wrq.u.mode = IEEE80211_PARAM_MCASTCIPHER;
 630         if( madwifi_wrq(&wrq, ifname, IEEE80211_IOCTL_GETPARAM, NULL, 0) >= 0 )
 631         {
 632                 ciphers = wrq.u.mode;
 633
 634                 switch(wrq.u.mode) {
 635                         case IEEE80211_CIPHER_TKIP:
 636                                 c->group_ciphers |= IWINFO_CIPHER_TKIP;
 637                                 break;
 638
 639                         case IEEE80211_CIPHER_AES_CCM:
 640                                 c->group_ciphers |= IWINFO_CIPHER_CCMP;
 641                                 break;
 642
 643                         case IEEE80211_CIPHER_AES_OCB:
 644                                 c->group_ciphers |= IWINFO_CIPHER_AESOCB;
 645                                 break;
 646
 647                         case IEEE80211_CIPHER_CKIP:
 648                                 c->group_ciphers |= IWINFO_CIPHER_CKIP;
 649                                 break;
 650
 651                         case IEEE80211_CIPHER_WEP:
 652                                 switch(key_len) {
 653                                         case 13:
 654                                                 c->group_ciphers |= IWINFO_CIPHER_WEP104;
 655                                                 break;
 656
 657                                         case 5:
 658                                                 c->group_ciphers |= IWINFO_CIPHER_WEP40;
 659                                                 break;
 660
 661                                         default:
 662                                                 break;
 663                                 }
 664                                 break;
 665
 666                         case IEEE80211_CIPHER_NONE:
 667                                 c->group_ciphers |= IWINFO_CIPHER_NONE;
 668                                 break;
 669
 670                         default:
 671                                 break;
 672                 }
 673         }
 674
 675         c->enabled = (c->wpa_version || c->auth_algs) ? 1 : 0;
 676
 677         return 0;
 678 }
 679
 680 int madwifi_get_assoclist(const char *ifname, char *buf, int *len)
 681 {
 682         int bl, tl, noise;
 683         uint8_t *cp;
 684         uint8_t tmp[24*1024];
 685         struct ieee80211req_sta_info *si;
 686         struct iwinfo_assoclist_entry entry;
 687
 688         if( (tl = get80211priv(ifname, IEEE80211_IOCTL_STA_INFO, tmp, 24*1024)) > 0 )
 689         {
 690                 cp = tmp;
 691                 bl = 0;
 692
 693                 if( madwifi_get_noise(ifname, &noise) )
 694                         noise = 0;
 695
 696                 do {
 697                         si = (struct ieee80211req_sta_info *) cp;
 698
 699                         entry.signal = (si->isi_rssi - 95);
 700                         entry.noise  = noise;
 701                         memcpy(entry.mac, &si->isi_macaddr, 6);
 702                         memcpy(&buf[bl], &entry, sizeof(struct iwinfo_assoclist_entry));
 703
 704                         bl += sizeof(struct iwinfo_assoclist_entry);
 705                         cp += si->isi_len;
 706                         tl -= si->isi_len;
 707                 } while (tl >= sizeof(struct ieee80211req_sta_info));
 708
 709                 *len = bl;
 710                 return 0;
 711         }
 712
 713         return -1;
 714 }
 715
 716 int madwifi_get_txpwrlist(const char *ifname, char *buf, int *len)
 717 {
 718         int rc = -1;
 719         char *res;
 720
 721         /* A wifiX device? */
 722         if( madwifi_iswifi(ifname) )
 723         {
 724                 if( (res = madwifi_ifadd(ifname)) != NULL )
 725                 {
 726                         rc = wext_get_txpwrlist(res, buf, len);
 727                         madwifi_ifdel(res);
 728                 }
 729         }
 730
 731         /* Its an athX ... */
 732         else if( !!madwifi_isvap(ifname, NULL) )
 733         {
 734                 rc = wext_get_txpwrlist(ifname, buf, len);
 735         }
 736
 737         return rc;
 738 }
 739
 740 int madwifi_get_scanlist(const char *ifname, char *buf, int *len)
 741 {
 742         int ret;
 743         char *res;
 744         DIR *proc;
 745         struct dirent *e;
 746
 747         ret = -1;
 748
 749         /* We got a wifiX device passed, try to lookup a vap on it */
 750         if( madwifi_iswifi(ifname) )
 751         {
 752                 if( (proc = opendir("/proc/sys/net/")) != NULL )
 753                 {
 754                         while( (e = readdir(proc)) != NULL )
 755                         {
 756                                 if( !!madwifi_isvap(e->d_name, ifname) )
 757                                 {
 758                                         if( iwinfo_ifup(e->d_name) )
 759                                         {
 760                                                 ret = wext_get_scanlist(e->d_name, buf, len);
 761                                                 break;
 762                                         }
 763                                 }
 764                         }
 765
 766                         closedir(proc);
 767                 }
 768
 769                 /* Still nothing found, try to create a vap */
 770                 if( ret == -1 )
 771                 {
 772                         if( (res = madwifi_ifadd(ifname)) != NULL )
 773                         {
 774                                 if( iwinfo_ifup(res) )
 775                                         ret = wext_get_scanlist(res, buf, len);
 776
 777                                 iwinfo_ifdown(res);
 778                                 madwifi_ifdel(res);
 779                         }
 780                 }
 781         }
 782
 783         /* Got athX device? */
 784         else if( !!madwifi_isvap(ifname, NULL) )
 785         {
 786                 ret = wext_get_scanlist(ifname, buf, len);
 787         }
 788
 789         return ret;
 790 }
 791
 792 int madwifi_get_freqlist(const char *ifname, char *buf, int *len)
 793 {
 794         int i, bl;
 795         int rc = -1;
 796         char *res;
 797         struct ieee80211req_chaninfo chans;
 798         struct iwinfo_freqlist_entry entry;
 799
 800         /* A wifiX device? */
 801         if( madwifi_iswifi(ifname) )
 802         {
 803                 if( (res = madwifi_ifadd(ifname)) != NULL )
 804                 {
 805                         rc = get80211priv(res, IEEE80211_IOCTL_GETCHANINFO,
 806                                                           &chans, sizeof(chans));
 807
 808                         madwifi_ifdel(res);
 809                 }
 810         }
 811
 812         /* Its an athX ... */
 813         else if( !!madwifi_isvap(ifname, NULL) )
 814         {
 815                 rc = get80211priv(ifname, IEEE80211_IOCTL_GETCHANINFO,
 816                                                   &chans, sizeof(chans));
 817         }
 818
 819
 820         /* Got chaninfo? */
 821         if( rc >= 0 )
 822         {
 823                 bl = 0;
 824
 825                 for( i = 0; i < chans.ic_nchans; i++ )
 826                 {
 827                         entry.mhz        = chans.ic_chans[i].ic_freq;
 828                         entry.channel    = chans.ic_chans[i].ic_ieee;
 829                         entry.restricted = 0;
 830
 831                         memcpy(&buf[bl], &entry, sizeof(struct iwinfo_freqlist_entry));
 832                         bl += sizeof(struct iwinfo_freqlist_entry);
 833                 }
 834
 835                 *len = bl;
 836                 return 0;
 837         }
 838
 839         return -1;
 840 }
 841
 842 int madwifi_get_country(const char *ifname, char *buf)
 843 {
 844         int i, fd, ccode = -1;
 845         char buffer[34];
 846         char *wifi = madwifi_iswifi(ifname)
 847                 ? (char *)ifname : madwifi_isvap(ifname, NULL);
 848
 849         struct ISO3166_to_CCode *e;
 850
 851         if( wifi )
 852         {
 853                 snprintf(buffer, sizeof(buffer), "/proc/sys/dev/%s/countrycode", wifi);
 854
 855                 if( (fd = open(buffer, O_RDONLY)) > -1 )
 856                 {
 857                         memset(buffer, 0, sizeof(buffer));
 858
 859                         if( read(fd, buffer, sizeof(buffer)-1) > 0 )
 860                                 ccode = atoi(buffer);
 861
 862                         close(fd);
 863                 }
 864         }
 865
 866         for( i = 0; i < (sizeof(CountryCodes)/sizeof(CountryCodes[0])); i++ )
 867         {
 868                 e = &CountryCodes[i];
 869
 870                 if( e->ccode == ccode )
 871                 {
 872                         sprintf(buf, "%c%c", e->iso3166 / 256, e->iso3166 % 256);
 873                         return 0;
 874                 }
 875         }
 876
 877         return -1;
 878 }
 879
 880 int madwifi_get_countrylist(const char *ifname, char *buf, int *len)
 881 {
 882         int i, count;
 883         struct ISO3166_to_CCode *e, *p = NULL;
 884         struct iwinfo_country_entry *c = (struct iwinfo_country_entry *)buf;
 885
 886         count = 0;
 887
 888         for( int i = 0; i < (sizeof(CountryCodes)/sizeof(CountryCodes[0])); i++ )
 889         {
 890                 e = &CountryCodes[i];
 891
 892                 if( !p || (e->iso3166 != p->iso3166) )
 893                 {
 894                         c->iso3166 = e->iso3166;
 895                         snprintf(c->ccode, sizeof(c->ccode), "%i", e->ccode);
 896
 897                         c++;
 898                         count++;
 899                 }
 900
 901                 p = e;
 902         }
 903
 904         *len = (count * sizeof(struct iwinfo_country_entry));
 905         return 0;
 906 }
 907
 908 int madwifi_get_hwmodelist(const char *ifname, int *buf)
 909 {
 910         char chans[IWINFO_BUFSIZE] = { 0 };
 911         struct iwinfo_freqlist_entry *e = NULL;
 912         int len = 0;
 913
 914         if( !madwifi_get_freqlist(ifname, chans, &len) )
 915         {
 916                 for( e = (struct iwinfo_freqlist_entry *)chans; e->channel; e++ )
 917                 {
 918                         if( e->channel <= 14 )
 919                         {
 920                                 *buf |= IWINFO_80211_B;
 921                                 *buf |= IWINFO_80211_G;
 922                         }
 923                         else
 924                         {
 925                                 *buf |= IWINFO_80211_A;
 926                         }
 927                 }
 928
 929                 return 0;
 930         }
 931
 932         return -1;
 933 }
 934
 935 int madwifi_get_mbssid_support(const char *ifname, int *buf)
 936 {
 937         /* Test whether we can create another interface */
 938         char *nif = madwifi_ifadd(ifname);
 939
 940         if( nif )
 941         {
 942                 *buf = iwinfo_ifup(nif);
 943
 944                 iwinfo_ifdown(nif);
 945                 madwifi_ifdel(nif);
 946
 947                 return 0;
 948         }
 949
 950         return -1;
 951 }