drivers/staging/wlan-ng/cfg80211.c

   1 /* cfg80211 Interface for prism2_usb module */
   2
   3
   4 /* Prism2 channell/frequency/bitrate declarations */
   5 static const struct ieee80211_channel prism2_channels[] = {
   6         { .center_freq = 2412 },
   7         { .center_freq = 2417 },
   8         { .center_freq = 2422 },
   9         { .center_freq = 2427 },
  10         { .center_freq = 2432 },
  11         { .center_freq = 2437 },
  12         { .center_freq = 2442 },
  13         { .center_freq = 2447 },
  14         { .center_freq = 2452 },
  15         { .center_freq = 2457 },
  16         { .center_freq = 2462 },
  17         { .center_freq = 2467 },
  18         { .center_freq = 2472 },
  19         { .center_freq = 2484 },
  20 };
  21
  22 static const struct ieee80211_rate prism2_rates[] = {
  23         { .bitrate = 10 },
  24         { .bitrate = 20 },
  25         { .bitrate = 55 },
  26         { .bitrate = 110 }
  27 };
  28
  29 #define PRISM2_NUM_CIPHER_SUITES 2
  30 static const u32 prism2_cipher_suites[PRISM2_NUM_CIPHER_SUITES] = {
  31         WLAN_CIPHER_SUITE_WEP40,
  32         WLAN_CIPHER_SUITE_WEP104
  33 };
  34
  35
  36 /* prism2 device private data */
  37 struct prism2_wiphy_private {
  38         wlandevice_t *wlandev;
  39
  40         struct ieee80211_supported_band band;
  41         struct ieee80211_channel channels[ARRAY_SIZE(prism2_channels)];
  42         struct ieee80211_rate rates[ARRAY_SIZE(prism2_rates)];
  43
  44         struct cfg80211_scan_request *scan_request;
  45 };
  46
  47 static const void * const prism2_wiphy_privid = &prism2_wiphy_privid;
  48
  49
  50 /* Helper Functions */
  51 static int prism2_result2err(int prism2_result)
  52 {
  53         int err = 0;
  54
  55         switch (prism2_result) {
  56         case P80211ENUM_resultcode_invalid_parameters:
  57                 err = -EINVAL;
  58                 break;
  59         case P80211ENUM_resultcode_implementation_failure:
  60                 err = -EIO;
  61                 break;
  62         case P80211ENUM_resultcode_not_supported:
  63                 err = -EOPNOTSUPP;
  64                 break;
  65         default:
  66                 err = 0;
  67                 break;
  68         }
  69
  70         return err;
  71 }
  72
  73 static int prism2_domibset_uint32(wlandevice_t *wlandev, u32 did, u32 data)
  74 {
  75         struct p80211msg_dot11req_mibset msg;
  76         p80211item_uint32_t *mibitem = (p80211item_uint32_t *) &msg.mibattribute.data;
  77
  78         msg.msgcode = DIDmsg_dot11req_mibset;
  79         mibitem->did = did;
  80         mibitem->data = data;
  81
  82         return p80211req_dorequest(wlandev, (u8 *) &msg);
  83 }
  84
  85 static int prism2_domibset_pstr32(wlandevice_t *wlandev,
  86                                   u32 did, u8 len, u8 *data)
  87 {
  88         struct p80211msg_dot11req_mibset msg;
  89         p80211item_pstr32_t *mibitem = (p80211item_pstr32_t *) &msg.mibattribute.data;
  90
  91         msg.msgcode = DIDmsg_dot11req_mibset;
  92         mibitem->did = did;
  93         mibitem->data.len = len;
  94         memcpy(mibitem->data.data, data, len);
  95
  96         return p80211req_dorequest(wlandev, (u8 *) &msg);
  97 }
  98
  99
 100 /* The interface functions, called by the cfg80211 layer */
 101 int prism2_change_virtual_intf(struct wiphy *wiphy,
 102                                struct net_device *dev,
 103                                enum nl80211_iftype type, u32 *flags,
 104                                struct vif_params *params)
 105 {
 106         wlandevice_t *wlandev = dev->ml_priv;
 107         u32 data;
 108         int result;
 109         int err = 0;
 110
 111         switch (type) {
 112         case NL80211_IFTYPE_ADHOC:
 113                 if (wlandev->macmode == WLAN_MACMODE_IBSS_STA)
 114                         goto exit;
 115                 wlandev->macmode = WLAN_MACMODE_IBSS_STA;
 116                 data = 0;
 117                 break;
 118         case NL80211_IFTYPE_STATION:
 119                 if (wlandev->macmode == WLAN_MACMODE_ESS_STA)
 120                         goto exit;
 121                 wlandev->macmode = WLAN_MACMODE_ESS_STA;
 122                 data = 1;
 123                 break;
 124         default:
 125                 printk(KERN_WARNING "Operation mode: %d not support\n", type);
 126                 return -EOPNOTSUPP;
 127         }
 128
 129         /* Set Operation mode to the PORT TYPE RID */
 130         result = prism2_domibset_uint32(wlandev, DIDmib_p2_p2Static_p2CnfPortType, data);
 131
 132         if (result)
 133                 err = -EFAULT;
 134
 135         dev->ieee80211_ptr->iftype = type;
 136
 137 exit:
 138         return err;
 139 }
 140
 141 int prism2_add_key(struct wiphy *wiphy, struct net_device *dev,
 142                    u8 key_index, bool pairwise, const u8 *mac_addr,
 143                    struct key_params *params)
 144 {
 145         wlandevice_t *wlandev = dev->ml_priv;
 146         u32 did;
 147
 148         int err = 0;
 149         int result = 0;
 150
 151         switch (params->cipher) {
 152         case WLAN_CIPHER_SUITE_WEP40:
 153         case WLAN_CIPHER_SUITE_WEP104:
 154                 result = prism2_domibset_uint32(wlandev,
 155                                                 DIDmib_dot11smt_dot11PrivacyTable_dot11WEPDefaultKeyID,
 156                                                 key_index);
 157                 if (result)
 158                         goto exit;
 159
 160                 /* send key to driver */
 161                 switch (key_index) {
 162                 case 0:
 163                         did = DIDmib_dot11smt_dot11WEPDefaultKeysTable_dot11WEPDefaultKey0;
 164                         break;
 165
 166                 case 1:
 167                         did = DIDmib_dot11smt_dot11WEPDefaultKeysTable_dot11WEPDefaultKey1;
 168                         break;
 169
 170                 case 2:
 171                         did = DIDmib_dot11smt_dot11WEPDefaultKeysTable_dot11WEPDefaultKey2;
 172                         break;
 173
 174                 case 3:
 175                         did = DIDmib_dot11smt_dot11WEPDefaultKeysTable_dot11WEPDefaultKey3;
 176                         break;
 177
 178                 default:
 179                         err = -EINVAL;
 180                         goto exit;
 181                 }
 182
 183                 result = prism2_domibset_pstr32(wlandev, did, params->key_len, params->key);
 184                 if (result)
 185                         goto exit;
 186                 break;
 187
 188         default:
 189                 pr_debug("Unsupported cipher suite\n");
 190                 result = 1;
 191         }
 192
 193 exit:
 194         if (result)
 195                 err = -EFAULT;
 196
 197         return err;
 198 }
 199
 200 int prism2_get_key(struct wiphy *wiphy, struct net_device *dev,
 201                    u8 key_index, bool pairwise, const u8 *mac_addr, void *cookie,
 202                    void (*callback)(void *cookie, struct key_params*))
 203 {
 204         wlandevice_t *wlandev = dev->ml_priv;
 205         struct key_params params;
 206         int len;
 207
 208         if (key_index >= NUM_WEPKEYS)
 209                 return -EINVAL;
 210
 211         len = wlandev->wep_keylens[key_index];
 212         memset(&params, 0, sizeof(params));
 213
 214         if (len == 13)
 215                 params.cipher = WLAN_CIPHER_SUITE_WEP104;
 216         else if (len == 5)
 217                 params.cipher = WLAN_CIPHER_SUITE_WEP104;
 218         else
 219                 return -ENOENT;
 220         params.key_len = len;
 221         params.key = wlandev->wep_keys[key_index];
 222         params.seq_len = 0;
 223
 224         callback(cookie, &params);
 225
 226         return 0;
 227 }
 228
 229 int prism2_del_key(struct wiphy *wiphy, struct net_device *dev,
 230                    u8 key_index, bool pairwise, const u8 *mac_addr)
 231 {
 232         wlandevice_t *wlandev = dev->ml_priv;
 233         u32 did;
 234         int err = 0;
 235         int result = 0;
 236
 237         /* There is no direct way in the hardware (AFAIK) of removing
 238            a key, so we will cheat by setting the key to a bogus value */
 239         /* send key to driver */
 240         switch (key_index) {
 241         case 0:
 242                 did =
 243                     DIDmib_dot11smt_dot11WEPDefaultKeysTable_dot11WEPDefaultKey0;
 244                 break;
 245
 246         case 1:
 247                 did =
 248                     DIDmib_dot11smt_dot11WEPDefaultKeysTable_dot11WEPDefaultKey1;
 249                 break;
 250
 251         case 2:
 252                 did =
 253                     DIDmib_dot11smt_dot11WEPDefaultKeysTable_dot11WEPDefaultKey2;
 254                 break;
 255
 256         case 3:
 257                 did =
 258                     DIDmib_dot11smt_dot11WEPDefaultKeysTable_dot11WEPDefaultKey3;
 259                 break;
 260
 261         default:
 262                 err = -EINVAL;
 263                 goto exit;
 264         }
 265
 266         result = prism2_domibset_pstr32(wlandev, did, 13, "0000000000000");
 267
 268 exit:
 269         if (result)
 270                 err = -EFAULT;
 271
 272         return err;
 273 }
 274
 275 int prism2_set_default_key(struct wiphy *wiphy, struct net_device *dev,
 276                            u8 key_index, bool unicast, bool multicast)
 277 {
 278         wlandevice_t *wlandev = dev->ml_priv;
 279
 280         int err = 0;
 281         int result = 0;
 282
 283         result = prism2_domibset_uint32(wlandev,
 284                 DIDmib_dot11smt_dot11PrivacyTable_dot11WEPDefaultKeyID,
 285                 key_index);
 286
 287         if (result)
 288                 err = -EFAULT;
 289
 290         return err;
 291 }
 292
 293
 294 int prism2_get_station(struct wiphy *wiphy, struct net_device *dev,
 295                        u8 *mac, struct station_info *sinfo)
 296 {
 297         wlandevice_t *wlandev = dev->ml_priv;
 298         struct p80211msg_lnxreq_commsquality quality;
 299         int result;
 300
 301         memset(sinfo, 0, sizeof(*sinfo));
 302
 303         if ((wlandev == NULL) || (wlandev->msdstate != WLAN_MSD_RUNNING))
 304                 return -EOPNOTSUPP;
 305
 306         /* build request message */
 307         quality.msgcode = DIDmsg_lnxreq_commsquality;
 308         quality.dbm.data = P80211ENUM_truth_true;
 309         quality.dbm.status = P80211ENUM_msgitem_status_data_ok;
 310
 311         /* send message to nsd */
 312         if (wlandev->mlmerequest == NULL)
 313                 return -EOPNOTSUPP;
 314
 315         result = wlandev->mlmerequest(wlandev, (struct p80211msg *) &quality);
 316
 317
 318         if (result == 0) {
 319                 sinfo->txrate.legacy = quality.txrate.data;
 320                 sinfo->filled |= STATION_INFO_TX_BITRATE;
 321                 sinfo->signal = quality.level.data;
 322                 sinfo->filled |= STATION_INFO_SIGNAL;
 323         }
 324
 325         return result;
 326 }
 327
 328 int prism2_scan(struct wiphy *wiphy, struct net_device *dev,
 329                 struct cfg80211_scan_request *request)
 330 {
 331         struct prism2_wiphy_private *priv = wiphy_priv(wiphy);
 332         wlandevice_t *wlandev = dev->ml_priv;
 333         struct p80211msg_dot11req_scan msg1;
 334         struct p80211msg_dot11req_scan_results msg2;
 335         struct cfg80211_bss *bss;
 336         int result;
 337         int err = 0;
 338         int numbss = 0;
 339         int i = 0;
 340         u8 ie_buf[46];
 341         int ie_len;
 342
 343         if (!request)
 344                 return -EINVAL;
 345
 346         if (priv->scan_request && priv->scan_request != request)
 347                 return -EBUSY;
 348
 349         if (wlandev->macmode == WLAN_MACMODE_ESS_AP) {
 350                 printk(KERN_ERR "Can't scan in AP mode\n");
 351                 return -EOPNOTSUPP;
 352         }
 353
 354         priv->scan_request = request;
 355
 356         memset(&msg1, 0x00, sizeof(struct p80211msg_dot11req_scan));
 357         msg1.msgcode = DIDmsg_dot11req_scan;
 358         msg1.bsstype.data = P80211ENUM_bsstype_any;
 359
 360         memset(&msg1.bssid.data.data, 0xFF, sizeof(msg1.bssid.data.data));
 361         msg1.bssid.data.len = 6;
 362
 363         if (request->n_ssids > 0) {
 364                 msg1.scantype.data = P80211ENUM_scantype_active;
 365                 msg1.ssid.data.len = request->ssids->ssid_len;
 366                 memcpy(msg1.ssid.data.data, request->ssids->ssid, request->ssids->ssid_len);
 367         } else {
 368                 msg1.scantype.data = 0;
 369         }
 370         msg1.probedelay.data = 0;
 371
 372         for (i = 0;
 373                 (i < request->n_channels) && i < ARRAY_SIZE(prism2_channels);
 374                 i++)
 375                 msg1.channellist.data.data[i] =
 376                         ieee80211_frequency_to_channel(request->channels[i]->center_freq);
 377         msg1.channellist.data.len = request->n_channels;
 378
 379         msg1.maxchanneltime.data = 250;
 380         msg1.minchanneltime.data = 200;
 381
 382         result = p80211req_dorequest(wlandev, (u8 *) &msg1);
 383         if (result) {
 384                 err = prism2_result2err(msg1.resultcode.data);
 385                 goto exit;
 386         }
 387         /* Now retrieve scan results */
 388         numbss = msg1.numbss.data;
 389
 390         for (i = 0; i < numbss; i++) {
 391                 memset(&msg2, 0, sizeof(msg2));
 392                 msg2.msgcode = DIDmsg_dot11req_scan_results;
 393                 msg2.bssindex.data = i;
 394
 395                 result = p80211req_dorequest(wlandev, (u8 *) &msg2);
 396                 if ((result != 0) ||
 397                     (msg2.resultcode.data != P80211ENUM_resultcode_success)) {
 398                         break;
 399                 }
 400
 401                 ie_buf[0] = WLAN_EID_SSID;
 402                 ie_buf[1] = msg2.ssid.data.len;
 403                 ie_len = ie_buf[1] + 2;
 404                 memcpy(&ie_buf[2], &(msg2.ssid.data.data), msg2.ssid.data.len);
 405                 bss = cfg80211_inform_bss(wiphy,
 406                         ieee80211_get_channel(wiphy, ieee80211_dsss_chan_to_freq(msg2.dschannel.data)),
 407                         (const u8 *) &(msg2.bssid.data.data),
 408                         msg2.timestamp.data, msg2.capinfo.data,
 409                         msg2.beaconperiod.data,
 410                         ie_buf,
 411                         ie_len,
 412                         (msg2.signal.data - 65536) * 100, /* Conversion to signed type */
 413                         GFP_KERNEL
 414                 );
 415
 416                 if (!bss) {
 417                         err = -ENOMEM;
 418                         goto exit;
 419                 }
 420
 421                 cfg80211_put_bss(bss);
 422         }
 423
 424         if (result)
 425                 err = prism2_result2err(msg2.resultcode.data);
 426
 427 exit:
 428         cfg80211_scan_done(request, err ? 1 : 0);
 429         priv->scan_request = NULL;
 430         return err;
 431 }
 432
 433 int prism2_set_wiphy_params(struct wiphy *wiphy, u32 changed)
 434 {
 435         struct prism2_wiphy_private *priv = wiphy_priv(wiphy);
 436         wlandevice_t *wlandev = priv->wlandev;
 437         u32 data;
 438         int result;
 439         int err = 0;
 440
 441         if (changed & WIPHY_PARAM_RTS_THRESHOLD) {
 442                 if (wiphy->rts_threshold == -1)
 443                         data = 2347;
 444                 else
 445                         data = wiphy->rts_threshold;
 446
 447                 result = prism2_domibset_uint32(wlandev,
 448                                                 DIDmib_dot11mac_dot11OperationTable_dot11RTSThreshold,
 449                                                 data);
 450                 if (result) {
 451                         err = -EFAULT;
 452                         goto exit;
 453                 }
 454         }
 455
 456         if (changed & WIPHY_PARAM_FRAG_THRESHOLD) {
 457                 if (wiphy->frag_threshold == -1)
 458                         data = 2346;
 459                 else
 460                         data = wiphy->frag_threshold;
 461
 462                 result = prism2_domibset_uint32(wlandev,
 463                                                 DIDmib_dot11mac_dot11OperationTable_dot11FragmentationThreshold,
 464                                                 data);
 465                 if (result) {
 466                         err = -EFAULT;
 467                         goto exit;
 468                 }
 469         }
 470
 471 exit:
 472         return err;
 473 }
 474
 475 int prism2_connect(struct wiphy *wiphy, struct net_device *dev,
 476                    struct cfg80211_connect_params *sme)
 477 {
 478         wlandevice_t *wlandev = dev->ml_priv;
 479         struct ieee80211_channel *channel = sme->channel;
 480         struct p80211msg_lnxreq_autojoin msg_join;
 481         u32 did;
 482         int length = sme->ssid_len;
 483         int chan = -1;
 484         int is_wep = (sme->crypto.cipher_group == WLAN_CIPHER_SUITE_WEP40) ||
 485             (sme->crypto.cipher_group == WLAN_CIPHER_SUITE_WEP104);
 486         int result;
 487         int err = 0;
 488
 489         /* Set the channel */
 490         if (channel) {
 491                 chan = ieee80211_frequency_to_channel(channel->center_freq);
 492                 result = prism2_domibset_uint32(wlandev,
 493                                                 DIDmib_dot11phy_dot11PhyDSSSTable_dot11CurrentChannel,
 494                                                 chan);
 495                 if (result)
 496                         goto exit;
 497         }
 498
 499         /* Set the authorisation */
 500         if ((sme->auth_type == NL80211_AUTHTYPE_OPEN_SYSTEM) ||
 501                 ((sme->auth_type == NL80211_AUTHTYPE_AUTOMATIC) && !is_wep))
 502                         msg_join.authtype.data = P80211ENUM_authalg_opensystem;
 503         else if ((sme->auth_type == NL80211_AUTHTYPE_SHARED_KEY) ||
 504                 ((sme->auth_type == NL80211_AUTHTYPE_AUTOMATIC) && is_wep))
 505                         msg_join.authtype.data = P80211ENUM_authalg_sharedkey;
 506         else
 507                 printk(KERN_WARNING
 508                         "Unhandled authorisation type for connect (%d)\n",
 509                         sme->auth_type);
 510
 511         /* Set the encryption - we only support wep */
 512         if (is_wep) {
 513                 if (sme->key) {
 514                         result = prism2_domibset_uint32(wlandev,
 515                                 DIDmib_dot11smt_dot11PrivacyTable_dot11WEPDefaultKeyID,
 516                                 sme->key_idx);
 517                         if (result)
 518                                 goto exit;
 519
 520                         /* send key to driver */
 521                         switch (sme->key_idx) {
 522                         case 0:
 523                                 did = DIDmib_dot11smt_dot11WEPDefaultKeysTable_dot11WEPDefaultKey0;
 524                                 break;
 525
 526                         case 1:
 527                                 did = DIDmib_dot11smt_dot11WEPDefaultKeysTable_dot11WEPDefaultKey1;
 528                                 break;
 529
 530                         case 2:
 531                                 did = DIDmib_dot11smt_dot11WEPDefaultKeysTable_dot11WEPDefaultKey2;
 532                                 break;
 533
 534                         case 3:
 535                                 did = DIDmib_dot11smt_dot11WEPDefaultKeysTable_dot11WEPDefaultKey3;
 536                                 break;
 537
 538                         default:
 539                                 err = -EINVAL;
 540                                 goto exit;
 541                         }
 542
 543                         result = prism2_domibset_pstr32(wlandev, did, sme->key_len, (u8 *) sme->key);
 544                         if (result)
 545                                 goto exit;
 546
 547                 }
 548
 549                 /* Assume we should set privacy invoked and exclude unencrypted
 550                    We could possibly use sme->privacy here, but the assumption
 551                    seems reasonable anyway */
 552                 result = prism2_domibset_uint32(wlandev,
 553                                                 DIDmib_dot11smt_dot11PrivacyTable_dot11PrivacyInvoked,
 554                                                 P80211ENUM_truth_true);
 555                 if (result)
 556                         goto exit;
 557
 558                 result = prism2_domibset_uint32(wlandev,
 559                                                 DIDmib_dot11smt_dot11PrivacyTable_dot11ExcludeUnencrypted,
 560                                                 P80211ENUM_truth_true);
 561                 if (result)
 562                         goto exit;
 563
 564         } else {
 565                 /* Assume we should unset privacy invoked
 566                    and exclude unencrypted */
 567                 result = prism2_domibset_uint32(wlandev,
 568                                                 DIDmib_dot11smt_dot11PrivacyTable_dot11PrivacyInvoked,
 569                                                 P80211ENUM_truth_false);
 570                 if (result)
 571                         goto exit;
 572
 573                 result = prism2_domibset_uint32(wlandev,
 574                                                 DIDmib_dot11smt_dot11PrivacyTable_dot11ExcludeUnencrypted,
 575                                                 P80211ENUM_truth_false);
 576                 if (result)
 577                         goto exit;
 578
 579         }
 580
 581         /* Now do the actual join. Note there is no way that I can
 582            see to request a specific bssid */
 583         msg_join.msgcode = DIDmsg_lnxreq_autojoin;
 584
 585         memcpy(msg_join.ssid.data.data, sme->ssid, length);
 586         msg_join.ssid.data.len = length;
 587
 588         result = p80211req_dorequest(wlandev, (u8 *) &msg_join);
 589
 590 exit:
 591         if (result)
 592                 err = -EFAULT;
 593
 594         return err;
 595 }
 596
 597 int prism2_disconnect(struct wiphy *wiphy, struct net_device *dev,
 598                       u16 reason_code)
 599 {
 600         wlandevice_t *wlandev = dev->ml_priv;
 601         struct p80211msg_lnxreq_autojoin msg_join;
 602         int result;
 603         int err = 0;
 604
 605
 606         /* Do a join, with a bogus ssid. Thats the only way I can think of */
 607         msg_join.msgcode = DIDmsg_lnxreq_autojoin;
 608
 609         memcpy(msg_join.ssid.data.data, "---", 3);
 610         msg_join.ssid.data.len = 3;
 611
 612         result = p80211req_dorequest(wlandev, (u8 *) &msg_join);
 613
 614         if (result)
 615                 err = -EFAULT;
 616
 617         return err;
 618 }
 619
 620
 621 int prism2_join_ibss(struct wiphy *wiphy, struct net_device *dev,
 622                      struct cfg80211_ibss_params *params)
 623 {
 624         return -EOPNOTSUPP;
 625 }
 626
 627 int prism2_leave_ibss(struct wiphy *wiphy, struct net_device *dev)
 628 {
 629         return -EOPNOTSUPP;
 630 }
 631
 632
 633 int prism2_set_tx_power(struct wiphy *wiphy, enum nl80211_tx_power_setting type,
 634                         int mbm)
 635 {
 636         struct prism2_wiphy_private *priv = wiphy_priv(wiphy);
 637         wlandevice_t *wlandev = priv->wlandev;
 638         u32 data;
 639         int result;
 640         int err = 0;
 641
 642         if (type == NL80211_TX_POWER_AUTOMATIC)
 643                 data = 30;
 644         else
 645                 data = MBM_TO_DBM(mbm);
 646
 647         result = prism2_domibset_uint32(wlandev,
 648                 DIDmib_dot11phy_dot11PhyTxPowerTable_dot11CurrentTxPowerLevel,
 649                 data);
 650
 651         if (result) {
 652                 err = -EFAULT;
 653                 goto exit;
 654         }
 655
 656 exit:
 657         return err;
 658 }
 659
 660 int prism2_get_tx_power(struct wiphy *wiphy, int *dbm)
 661 {
 662         struct prism2_wiphy_private *priv = wiphy_priv(wiphy);
 663         wlandevice_t *wlandev = priv->wlandev;
 664         struct p80211msg_dot11req_mibget msg;
 665         p80211item_uint32_t *mibitem = (p80211item_uint32_t *) &msg.mibattribute.data;
 666         int result;
 667         int err = 0;
 668
 669         msg.msgcode = DIDmsg_dot11req_mibget;
 670         mibitem->did =
 671             DIDmib_dot11phy_dot11PhyTxPowerTable_dot11CurrentTxPowerLevel;
 672
 673         result = p80211req_dorequest(wlandev, (u8 *) &msg);
 674
 675         if (result) {
 676                 err = -EFAULT;
 677                 goto exit;
 678         }
 679
 680         *dbm = mibitem->data;
 681
 682 exit:
 683         return err;
 684 }
 685
 686
 687
 688
 689 /* Interface callback functions, passing data back up to the cfg80211 layer */
 690 void prism2_connect_result(wlandevice_t *wlandev, u8 failed)
 691 {
 692         u16 status = failed ? WLAN_STATUS_UNSPECIFIED_FAILURE : WLAN_STATUS_SUCCESS;
 693
 694         cfg80211_connect_result(wlandev->netdev, wlandev->bssid,
 695                                 NULL, 0, NULL, 0, status, GFP_KERNEL);
 696 }
 697
 698 void prism2_disconnected(wlandevice_t *wlandev)
 699 {
 700         cfg80211_disconnected(wlandev->netdev, 0, NULL,
 701                 0, GFP_KERNEL);
 702 }
 703
 704 void prism2_roamed(wlandevice_t *wlandev)
 705 {
 706         cfg80211_roamed(wlandev->netdev, NULL, wlandev->bssid,
 707                 NULL, 0, NULL, 0, GFP_KERNEL);
 708 }
 709
 710
 711 /* Structures for declaring wiphy interface */
 712 static const struct cfg80211_ops prism2_usb_cfg_ops = {
 713         .change_virtual_intf = prism2_change_virtual_intf,
 714         .add_key = prism2_add_key,
 715         .get_key = prism2_get_key,
 716         .del_key = prism2_del_key,
 717         .set_default_key = prism2_set_default_key,
 718         .get_station = prism2_get_station,
 719         .scan = prism2_scan,
 720         .set_wiphy_params = prism2_set_wiphy_params,
 721         .connect = prism2_connect,
 722         .disconnect = prism2_disconnect,
 723         .join_ibss = prism2_join_ibss,
 724         .leave_ibss = prism2_leave_ibss,
 725         .set_tx_power = prism2_set_tx_power,
 726         .get_tx_power = prism2_get_tx_power,
 727 };
 728
 729
 730 /* Functions to create/free wiphy interface */
 731 struct wiphy *wlan_create_wiphy(struct device *dev, wlandevice_t *wlandev)
 732 {
 733         struct wiphy *wiphy;
 734         struct prism2_wiphy_private *priv;
 735         wiphy = wiphy_new(&prism2_usb_cfg_ops, sizeof(struct prism2_wiphy_private));
 736         if (!wiphy)
 737                 return NULL;
 738
 739         priv = wiphy_priv(wiphy);
 740         priv->wlandev = wlandev;
 741         memcpy(priv->channels, prism2_channels, sizeof(prism2_channels));
 742         memcpy(priv->rates, prism2_rates, sizeof(prism2_rates));
 743         priv->band.channels = priv->channels;
 744         priv->band.n_channels = ARRAY_SIZE(prism2_channels);
 745         priv->band.bitrates = priv->rates;
 746         priv->band.n_bitrates = ARRAY_SIZE(prism2_rates);
 747         priv->band.band = IEEE80211_BAND_2GHZ;
 748         priv->band.ht_cap.ht_supported = false;
 749         wiphy->bands[IEEE80211_BAND_2GHZ] = &priv->band;
 750
 751         set_wiphy_dev(wiphy, dev);
 752         wiphy->privid = prism2_wiphy_privid;
 753         wiphy->max_scan_ssids = 1;
 754         wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION)
 755                                  | BIT(NL80211_IFTYPE_ADHOC);
 756         wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM;
 757         wiphy->n_cipher_suites = PRISM2_NUM_CIPHER_SUITES;
 758         wiphy->cipher_suites = prism2_cipher_suites;
 759
 760         if (wiphy_register(wiphy) < 0)
 761                 return NULL;
 762
 763         return wiphy;
 764 }
 765
 766
 767 void wlan_free_wiphy(struct wiphy *wiphy)
 768 {
 769         wiphy_unregister(wiphy);
 770         wiphy_free(wiphy);
 771 }