LXR linux/drivers/staging/rtl8712/rtl871x_ioctl

   1/******************************************************************************
   2 * rtl871x_ioctl_set.c
   3 *
   4 * Copyright(c) 2007 - 2010 Realtek Corporation. All rights reserved.
   5 * Linux device driver for RTL8192SU
   6 *
   7 * This program is free software; you can redistribute it and/or modify it
   8 * under the terms of version 2 of the GNU General Public License as
   9 * published by the Free Software Foundation.
  10 *
  11 * This program is distributed in the hope that it will be useful, but WITHOUT
  12 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  13 * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
  14 * more details.
  15 *
  16 * You should have received a copy of the GNU General Public License along with
  17 * this program; if not, write to the Free Software Foundation, Inc.,
  18 * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
  19 *
  20 * Modifications for inclusion into the Linux staging tree are
  21 * Copyright(c) 2010 Larry Finger. All rights reserved.
  22 *
  23 * Contact information:
  24 * WLAN FAE <wlanfae@realtek.com>
  25 * Larry Finger <Larry.Finger@lwfinger.net>
  26 *
  27 ******************************************************************************/
  28
  29#define _RTL871X_IOCTL_SET_C_
  30
  31#include "osdep_service.h"
  32#include "drv_types.h"
  33#include "rtl871x_ioctl_set.h"
  34#include "usb_osintf.h"
  35#include "usb_ops.h"
  36
  37#define IS_MAC_ADDRESS_BROADCAST(addr) \
  38( \
  39        ((addr[0] == 0xff) && (addr[1] == 0xff) && \
  40         (addr[2] == 0xff) && (addr[3] == 0xff) && \
  41         (addr[4] == 0xff) && (addr[5] == 0xff)) ? true : false \
  42)
  43
  44static u8 validate_ssid(struct ndis_802_11_ssid *ssid)
  45{
  46        u8 i;
  47
  48        if (ssid->SsidLength > 32)
  49                return false;
  50        for (i = 0; i < ssid->SsidLength; i++) {
  51                /* wifi, printable ascii code must be supported */
  52                if (!((ssid->Ssid[i] >= 0x20) && (ssid->Ssid[i] <= 0x7e)))
  53                        return false;
  54        }
  55        return true;
  56}
  57
  58static u8 do_join(struct _adapter *padapter)
  59{
  60        struct list_head *plist, *phead;
  61        u8 *pibss = NULL;
  62        struct  mlme_priv       *pmlmepriv = &(padapter->mlmepriv);
  63        struct  __queue *queue  = &(pmlmepriv->scanned_queue);
  64
  65        phead = get_list_head(queue);
  66        plist = get_next(phead);
  67        pmlmepriv->cur_network.join_res = -2;
  68        pmlmepriv->fw_state |= _FW_UNDER_LINKING;
  69        pmlmepriv->pscanned = plist;
  70        pmlmepriv->to_join = true;
  71        if (_queue_empty(queue) == true) {
  72                if (pmlmepriv->fw_state & _FW_UNDER_LINKING)
  73                        pmlmepriv->fw_state ^= _FW_UNDER_LINKING;
  74                /* when set_ssid/set_bssid for do_join(), but scanning queue
  75                 * is empty we try to issue sitesurvey firstly
  76                 */
  77                if (pmlmepriv->sitesurveyctrl.traffic_busy == false)
  78                        r8712_sitesurvey_cmd(padapter, &pmlmepriv->assoc_ssid);
  79                return true;
  80        } else {
  81                int ret;
  82
  83                ret = r8712_select_and_join_from_scan(pmlmepriv);
  84                if (ret == _SUCCESS)
  85                        _set_timer(&pmlmepriv->assoc_timer, MAX_JOIN_TIMEOUT);
  86                else {
  87                        if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)) {
  88                                /* submit r8712_createbss_cmd to change to an
  89                                 * ADHOC_MASTER pmlmepriv->lock has been
  90                                 * acquired by caller...
  91                                 */
  92                                struct wlan_bssid_ex *pdev_network =
  93                                        &(padapter->registrypriv.dev_network);
  94                                pmlmepriv->fw_state = WIFI_ADHOC_MASTER_STATE;
  95                                pibss = padapter->registrypriv.dev_network.
  96                                        MacAddress;
  97                                memset(&pdev_network->Ssid, 0,
  98                                        sizeof(struct ndis_802_11_ssid));
  99                                memcpy(&pdev_network->Ssid,
 100                                        &pmlmepriv->assoc_ssid,
 101                                        sizeof(struct ndis_802_11_ssid));
 102                                r8712_update_registrypriv_dev_network(padapter);
 103                                r8712_generate_random_ibss(pibss);
 104                                if (r8712_createbss_cmd(padapter) != _SUCCESS)
 105                                        return false;
 106                                pmlmepriv->to_join = false;
 107                        } else {
 108                                /* can't associate ; reset under-linking */
 109                                if (pmlmepriv->fw_state & _FW_UNDER_LINKING)
 110                                        pmlmepriv->fw_state ^=
 111                                                             _FW_UNDER_LINKING;
 112                                /* when set_ssid/set_bssid for do_join(), but
 113                                 * there are no desired bss in scanning queue
 114                                 * we try to issue sitesurvey first
 115                                 */
 116                                if (!pmlmepriv->sitesurveyctrl.traffic_busy)
 117                                        r8712_sitesurvey_cmd(padapter,
 118                                                       &pmlmepriv->assoc_ssid);
 119                        }
 120                }
 121        }
 122        return true;
 123}
 124
 125u8 r8712_set_802_11_bssid(struct _adapter *padapter, u8 *bssid)
 126{
 127        unsigned long irqL;
 128        u8 status = true;
 129        struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
 130
 131        if ((bssid[0] == 0x00 && bssid[1] == 0x00 && bssid[2] == 0x00 &&
 132             bssid[3] == 0x00 && bssid[4] == 0x00 && bssid[5] == 0x00) ||
 133            (bssid[0] == 0xFF && bssid[1] == 0xFF && bssid[2] == 0xFF &&
 134             bssid[3] == 0xFF && bssid[4] == 0xFF && bssid[5] == 0xFF)) {
 135                status = false;
 136                return status;
 137        }
 138        spin_lock_irqsave(&pmlmepriv->lock, irqL);
 139        if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY |
 140            _FW_UNDER_LINKING) == true) {
 141                status = check_fwstate(pmlmepriv, _FW_UNDER_LINKING);
 142                goto _Abort_Set_BSSID;
 143        }
 144        if (check_fwstate(pmlmepriv,
 145            _FW_LINKED|WIFI_ADHOC_MASTER_STATE) == true) {
 146                if (!memcmp(&pmlmepriv->cur_network.network.MacAddress, bssid,
 147                    ETH_ALEN)) {
 148                        if (check_fwstate(pmlmepriv,
 149                            WIFI_STATION_STATE) == false)
 150                                goto _Abort_Set_BSSID; /* driver is in
 151                                                * WIFI_ADHOC_MASTER_STATE */
 152                } else {
 153                        r8712_disassoc_cmd(padapter);
 154                        if (check_fwstate(pmlmepriv, _FW_LINKED) == true)
 155                                r8712_ind_disconnect(padapter);
 156                        r8712_free_assoc_resources(padapter);
 157                        if ((check_fwstate(pmlmepriv,
 158                             WIFI_ADHOC_MASTER_STATE))) {
 159                                _clr_fwstate_(pmlmepriv,
 160                                              WIFI_ADHOC_MASTER_STATE);
 161                                set_fwstate(pmlmepriv, WIFI_ADHOC_STATE);
 162                        }
 163                }
 164        }
 165        memcpy(&pmlmepriv->assoc_bssid, bssid, ETH_ALEN);
 166        pmlmepriv->assoc_by_bssid = true;
 167        status = do_join(padapter);
 168        goto done;
 169_Abort_Set_BSSID:
 170done:
 171        spin_unlock_irqrestore(&pmlmepriv->lock, irqL);
 172        return status;
 173}
 174
 175void r8712_set_802_11_ssid(struct _adapter *padapter,
 176                           struct ndis_802_11_ssid *ssid)
 177{
 178        unsigned long irqL;
 179        struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
 180        struct wlan_network *pnetwork = &pmlmepriv->cur_network;
 181
 182        if (padapter->hw_init_completed == false)
 183                return;
 184        spin_lock_irqsave(&pmlmepriv->lock, irqL);
 185        if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY|_FW_UNDER_LINKING)) {
 186                check_fwstate(pmlmepriv, _FW_UNDER_LINKING);
 187                goto _Abort_Set_SSID;
 188        }
 189        if (check_fwstate(pmlmepriv, _FW_LINKED|WIFI_ADHOC_MASTER_STATE)) {
 190                if ((pmlmepriv->assoc_ssid.SsidLength == ssid->SsidLength) &&
 191                    (!memcmp(&pmlmepriv->assoc_ssid.Ssid, ssid->Ssid,
 192                    ssid->SsidLength))) {
 193                        if ((check_fwstate(pmlmepriv,
 194                             WIFI_STATION_STATE) == false)) {
 195                                if (r8712_is_same_ibss(padapter,
 196                                     pnetwork) == false) {
 197                                        /* if in WIFI_ADHOC_MASTER_STATE or
 198                                         *  WIFI_ADHOC_STATE, create bss or
 199                                         * rejoin again
 200                                         */
 201                                        r8712_disassoc_cmd(padapter);
 202                                        if (check_fwstate(pmlmepriv,
 203                                            _FW_LINKED) == true)
 204                                                r8712_ind_disconnect(padapter);
 205                                        r8712_free_assoc_resources(padapter);
 206                                        if (check_fwstate(pmlmepriv,
 207                                             WIFI_ADHOC_MASTER_STATE)) {
 208                                                _clr_fwstate_(pmlmepriv,
 209                                                    WIFI_ADHOC_MASTER_STATE);
 210                                                set_fwstate(pmlmepriv,
 211                                                            WIFI_ADHOC_STATE);
 212                                        }
 213                                } else
 214                                        goto _Abort_Set_SSID; /* driver is in
 215                                                  * WIFI_ADHOC_MASTER_STATE */
 216                        }
 217                } else {
 218                        r8712_disassoc_cmd(padapter);
 219                        if (check_fwstate(pmlmepriv, _FW_LINKED) == true)
 220                                r8712_ind_disconnect(padapter);
 221                        r8712_free_assoc_resources(padapter);
 222                        if (check_fwstate(pmlmepriv,
 223                            WIFI_ADHOC_MASTER_STATE) == true) {
 224                                _clr_fwstate_(pmlmepriv,
 225                                              WIFI_ADHOC_MASTER_STATE);
 226                                set_fwstate(pmlmepriv, WIFI_ADHOC_STATE);
 227                        }
 228                }
 229        }
 230        if (padapter->securitypriv.btkip_countermeasure == true)
 231                goto _Abort_Set_SSID;
 232        if (validate_ssid(ssid) == false)
 233                goto _Abort_Set_SSID;
 234        memcpy(&pmlmepriv->assoc_ssid, ssid, sizeof(struct ndis_802_11_ssid));
 235        pmlmepriv->assoc_by_bssid = false;
 236        do_join(padapter);
 237        goto done;
 238_Abort_Set_SSID:
 239done:
 240        spin_unlock_irqrestore(&pmlmepriv->lock, irqL);
 241}
 242
 243u8 r8712_set_802_11_infrastructure_mode(struct _adapter *padapter,
 244        enum NDIS_802_11_NETWORK_INFRASTRUCTURE networktype)
 245{
 246        unsigned long irqL;
 247        struct mlme_priv        *pmlmepriv = &padapter->mlmepriv;
 248        struct wlan_network     *cur_network = &pmlmepriv->cur_network;
 249        enum NDIS_802_11_NETWORK_INFRASTRUCTURE *pold_state =
 250                                &(cur_network->network.InfrastructureMode);
 251
 252        if (*pold_state != networktype) {
 253                spin_lock_irqsave(&pmlmepriv->lock, irqL);
 254                if ((check_fwstate(pmlmepriv, _FW_LINKED) == true) ||
 255                    (*pold_state == Ndis802_11IBSS))
 256                        r8712_disassoc_cmd(padapter);
 257                if (check_fwstate(pmlmepriv,
 258                    _FW_LINKED|WIFI_ADHOC_MASTER_STATE) == true)
 259                        r8712_free_assoc_resources(padapter);
 260                if ((check_fwstate(pmlmepriv, _FW_LINKED) == true) ||
 261                    (*pold_state == Ndis802_11Infrastructure) ||
 262                    (*pold_state == Ndis802_11IBSS)) {
 263                        /* will clr Linked_state before this function,
 264                         * we must have chked whether issue dis-assoc_cmd or
 265                         * not */
 266                        r8712_ind_disconnect(padapter);
 267                }
 268                *pold_state = networktype;
 269                /* clear WIFI_STATION_STATE; WIFI_AP_STATE; WIFI_ADHOC_STATE;
 270                 * WIFI_ADHOC_MASTER_STATE */
 271                _clr_fwstate_(pmlmepriv, WIFI_STATION_STATE | WIFI_AP_STATE |
 272                              WIFI_ADHOC_STATE | WIFI_ADHOC_MASTER_STATE |
 273                              WIFI_AP_STATE);
 274                switch (networktype) {
 275                case Ndis802_11IBSS:
 276                        set_fwstate(pmlmepriv, WIFI_ADHOC_STATE);
 277                        break;
 278                case Ndis802_11Infrastructure:
 279                        set_fwstate(pmlmepriv, WIFI_STATION_STATE);
 280                        break;
 281                case Ndis802_11APMode:
 282                        set_fwstate(pmlmepriv, WIFI_AP_STATE);
 283                        break;
 284                case Ndis802_11AutoUnknown:
 285                case Ndis802_11InfrastructureMax:
 286                        break;
 287                }
 288                spin_unlock_irqrestore(&pmlmepriv->lock, irqL);
 289        }
 290        return true;
 291}
 292
 293u8 r8712_set_802_11_disassociate(struct _adapter *padapter)
 294{
 295        unsigned long irqL;
 296        struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
 297
 298        spin_lock_irqsave(&pmlmepriv->lock, irqL);
 299        if (check_fwstate(pmlmepriv, _FW_LINKED) == true) {
 300                r8712_disassoc_cmd(padapter);
 301                r8712_ind_disconnect(padapter);
 302                r8712_free_assoc_resources(padapter);
 303        }
 304        spin_unlock_irqrestore(&pmlmepriv->lock, irqL);
 305        return true;
 306}
 307
 308u8 r8712_set_802_11_bssid_list_scan(struct _adapter *padapter)
 309{
 310        struct mlme_priv *pmlmepriv = NULL;
 311        unsigned long irqL;
 312        u8 ret = true;
 313
 314        if (padapter == NULL)
 315                return false;
 316        pmlmepriv = &padapter->mlmepriv;
 317        if (padapter->hw_init_completed == false)
 318                return false;
 319        spin_lock_irqsave(&pmlmepriv->lock, irqL);
 320        if ((check_fwstate(pmlmepriv, _FW_UNDER_SURVEY|_FW_UNDER_LINKING)) ||
 321            (pmlmepriv->sitesurveyctrl.traffic_busy == true)) {
 322                /* Scan or linking is in progress, do nothing. */
 323                ret = (u8)check_fwstate(pmlmepriv, _FW_UNDER_SURVEY);
 324        } else {
 325                r8712_free_network_queue(padapter);
 326                ret = r8712_sitesurvey_cmd(padapter, NULL);
 327        }
 328        spin_unlock_irqrestore(&pmlmepriv->lock, irqL);
 329        return ret;
 330}
 331
 332u8 r8712_set_802_11_authentication_mode(struct _adapter *padapter,
 333                                enum NDIS_802_11_AUTHENTICATION_MODE authmode)
 334{
 335        struct security_priv *psecuritypriv = &padapter->securitypriv;
 336        u8 ret;
 337
 338        psecuritypriv->ndisauthtype = authmode;
 339        if (psecuritypriv->ndisauthtype > 3)
 340                psecuritypriv->AuthAlgrthm = 2; /* 802.1x */
 341        if (r8712_set_auth(padapter, psecuritypriv) == _SUCCESS)
 342                ret = true;
 343        else
 344                ret = false;
 345        return ret;
 346}
 347
 348u8 r8712_set_802_11_add_wep(struct _adapter *padapter,
 349                            struct NDIS_802_11_WEP *wep)
 350{
 351        u8      bdefaultkey;
 352        u8      btransmitkey;
 353        sint    keyid;
 354        struct security_priv *psecuritypriv = &padapter->securitypriv;
 355
 356        bdefaultkey = (wep->KeyIndex & 0x40000000) > 0 ? false : true;
 357        btransmitkey = (wep->KeyIndex & 0x80000000) > 0 ? true : false;
 358        keyid = wep->KeyIndex & 0x3fffffff;
 359        if (keyid >= WEP_KEYS)
 360                return false;
 361        switch (wep->KeyLength) {
 362        case 5:
 363                psecuritypriv->PrivacyAlgrthm = _WEP40_;
 364                break;
 365        case 13:
 366                psecuritypriv->PrivacyAlgrthm = _WEP104_;
 367                break;
 368        default:
 369                psecuritypriv->PrivacyAlgrthm = _NO_PRIVACY_;
 370                break;
 371        }
 372        memcpy(psecuritypriv->DefKey[keyid].skey, &wep->KeyMaterial,
 373                wep->KeyLength);
 374        psecuritypriv->DefKeylen[keyid] = wep->KeyLength;
 375        psecuritypriv->PrivacyKeyIndex = keyid;
 376        if (r8712_set_key(padapter, psecuritypriv, keyid) == _FAIL)
 377                return false;
 378        return _SUCCESS;
 379}
 380