linux/drivers/staging/rtl8712/rtl871x_ioctl_set.c
<<
>>
Prefs
   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
  38static u8 validate_ssid(struct ndis_802_11_ssid *ssid)
  39{
  40        u8 i;
  41
  42        if (ssid->SsidLength > 32)
  43                return false;
  44        for (i = 0; i < ssid->SsidLength; i++) {
  45                /* wifi, printable ascii code must be supported */
  46                if (!((ssid->Ssid[i] >= 0x20) && (ssid->Ssid[i] <= 0x7e)))
  47                        return false;
  48        }
  49        return true;
  50}
  51
  52static u8 do_join(struct _adapter *padapter)
  53{
  54        struct list_head *plist, *phead;
  55        u8 *pibss = NULL;
  56        struct  mlme_priv       *pmlmepriv = &(padapter->mlmepriv);
  57        struct  __queue *queue  = &(pmlmepriv->scanned_queue);
  58
  59        phead = &queue->queue;
  60        plist = phead->next;
  61        pmlmepriv->cur_network.join_res = -2;
  62        pmlmepriv->fw_state |= _FW_UNDER_LINKING;
  63        pmlmepriv->pscanned = plist;
  64        pmlmepriv->to_join = true;
  65
  66        /* adhoc mode will start with an empty queue, but skip checking */
  67        if (!check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) &&
  68            list_empty(&queue->queue)) {
  69                if (pmlmepriv->fw_state & _FW_UNDER_LINKING)
  70                        pmlmepriv->fw_state ^= _FW_UNDER_LINKING;
  71                /* when set_ssid/set_bssid for do_join(), but scanning queue
  72                 * is empty we try to issue sitesurvey firstly
  73                 */
  74                if (!pmlmepriv->sitesurveyctrl.traffic_busy)
  75                        r8712_sitesurvey_cmd(padapter, &pmlmepriv->assoc_ssid);
  76                return true;
  77        } else {
  78                int ret;
  79
  80                ret = r8712_select_and_join_from_scan(pmlmepriv);
  81                if (ret == _SUCCESS)
  82                        mod_timer(&pmlmepriv->assoc_timer,
  83                                  jiffies + msecs_to_jiffies(MAX_JOIN_TIMEOUT));
  84                else {
  85                        if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)) {
  86                                /* submit r8712_createbss_cmd to change to an
  87                                 * ADHOC_MASTER pmlmepriv->lock has been
  88                                 * acquired by caller...
  89                                 */
  90                                struct wlan_bssid_ex *pdev_network =
  91                                        &(padapter->registrypriv.dev_network);
  92                                pmlmepriv->fw_state = WIFI_ADHOC_MASTER_STATE;
  93                                pibss = padapter->registrypriv.dev_network.
  94                                        MacAddress;
  95                                memcpy(&pdev_network->Ssid,
  96                                        &pmlmepriv->assoc_ssid,
  97                                        sizeof(struct ndis_802_11_ssid));
  98                                r8712_update_registrypriv_dev_network(padapter);
  99                                r8712_generate_random_ibss(pibss);
 100                                if (r8712_createbss_cmd(padapter) != _SUCCESS)
 101                                        return false;
 102                                pmlmepriv->to_join = false;
 103                        } else {
 104                                /* can't associate ; reset under-linking */
 105                                if (pmlmepriv->fw_state & _FW_UNDER_LINKING)
 106                                        pmlmepriv->fw_state ^=
 107                                                             _FW_UNDER_LINKING;
 108                                /* when set_ssid/set_bssid for do_join(), but
 109                                 * there are no desired bss in scanning queue
 110                                 * we try to issue sitesurvey first
 111                                 */
 112                                if (!pmlmepriv->sitesurveyctrl.traffic_busy)
 113                                        r8712_sitesurvey_cmd(padapter,
 114                                                       &pmlmepriv->assoc_ssid);
 115                        }
 116                }
 117        }
 118        return true;
 119}
 120
 121u8 r8712_set_802_11_bssid(struct _adapter *padapter, u8 *bssid)
 122{
 123        unsigned long irqL;
 124        u8 status = true;
 125        struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
 126
 127        if (is_zero_ether_addr(bssid) || is_broadcast_ether_addr(bssid)) {
 128                status = false;
 129                return status;
 130        }
 131        spin_lock_irqsave(&pmlmepriv->lock, irqL);
 132        if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY |
 133            _FW_UNDER_LINKING)) {
 134                status = check_fwstate(pmlmepriv, _FW_UNDER_LINKING);
 135                goto _Abort_Set_BSSID;
 136        }
 137        if (check_fwstate(pmlmepriv,
 138            _FW_LINKED | WIFI_ADHOC_MASTER_STATE)) {
 139                if (!memcmp(&pmlmepriv->cur_network.network.MacAddress, bssid,
 140                    ETH_ALEN)) {
 141                        if (!check_fwstate(pmlmepriv, WIFI_STATION_STATE))
 142                                goto _Abort_Set_BSSID; /* driver is in
 143                                                * WIFI_ADHOC_MASTER_STATE
 144                                                */
 145                } else {
 146                        r8712_disassoc_cmd(padapter);
 147                        if (check_fwstate(pmlmepriv, _FW_LINKED))
 148                                r8712_ind_disconnect(padapter);
 149                        r8712_free_assoc_resources(padapter);
 150                        if ((check_fwstate(pmlmepriv,
 151                             WIFI_ADHOC_MASTER_STATE))) {
 152                                _clr_fwstate_(pmlmepriv,
 153                                              WIFI_ADHOC_MASTER_STATE);
 154                                set_fwstate(pmlmepriv, WIFI_ADHOC_STATE);
 155                        }
 156                }
 157        }
 158        memcpy(&pmlmepriv->assoc_bssid, bssid, ETH_ALEN);
 159        pmlmepriv->assoc_by_bssid = true;
 160        status = do_join(padapter);
 161        goto done;
 162_Abort_Set_BSSID:
 163done:
 164        spin_unlock_irqrestore(&pmlmepriv->lock, irqL);
 165        return status;
 166}
 167
 168void r8712_set_802_11_ssid(struct _adapter *padapter,
 169                           struct ndis_802_11_ssid *ssid)
 170{
 171        unsigned long irqL;
 172        struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
 173        struct wlan_network *pnetwork = &pmlmepriv->cur_network;
 174
 175        if (!padapter->hw_init_completed)
 176                return;
 177        spin_lock_irqsave(&pmlmepriv->lock, irqL);
 178        if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY | _FW_UNDER_LINKING)) {
 179                check_fwstate(pmlmepriv, _FW_UNDER_LINKING);
 180                goto _Abort_Set_SSID;
 181        }
 182        if (check_fwstate(pmlmepriv, _FW_LINKED | WIFI_ADHOC_MASTER_STATE)) {
 183                if ((pmlmepriv->assoc_ssid.SsidLength == ssid->SsidLength) &&
 184                    (!memcmp(&pmlmepriv->assoc_ssid.Ssid, ssid->Ssid,
 185                    ssid->SsidLength))) {
 186                        if (!check_fwstate(pmlmepriv, WIFI_STATION_STATE)) {
 187                                if (!r8712_is_same_ibss(padapter,
 188                                     pnetwork)) {
 189                                        /* if in WIFI_ADHOC_MASTER_STATE or
 190                                         *  WIFI_ADHOC_STATE, create bss or
 191                                         * rejoin again
 192                                         */
 193                                        r8712_disassoc_cmd(padapter);
 194                                        if (check_fwstate(pmlmepriv,
 195                                            _FW_LINKED))
 196                                                r8712_ind_disconnect(padapter);
 197                                        r8712_free_assoc_resources(padapter);
 198                                        if (check_fwstate(pmlmepriv,
 199                                             WIFI_ADHOC_MASTER_STATE)) {
 200                                                _clr_fwstate_(pmlmepriv,
 201                                                    WIFI_ADHOC_MASTER_STATE);
 202                                                set_fwstate(pmlmepriv,
 203                                                            WIFI_ADHOC_STATE);
 204                                        }
 205                                } else {
 206                                        goto _Abort_Set_SSID; /* driver is in
 207                                                * WIFI_ADHOC_MASTER_STATE
 208                                                */
 209                                }
 210                        }
 211                } else {
 212                        r8712_disassoc_cmd(padapter);
 213                        if (check_fwstate(pmlmepriv, _FW_LINKED))
 214                                r8712_ind_disconnect(padapter);
 215                        r8712_free_assoc_resources(padapter);
 216                        if (check_fwstate(pmlmepriv,
 217                            WIFI_ADHOC_MASTER_STATE)) {
 218                                _clr_fwstate_(pmlmepriv,
 219                                              WIFI_ADHOC_MASTER_STATE);
 220                                set_fwstate(pmlmepriv, WIFI_ADHOC_STATE);
 221                        }
 222                }
 223        }
 224        if (padapter->securitypriv.btkip_countermeasure)
 225                goto _Abort_Set_SSID;
 226        if (!validate_ssid(ssid))
 227                goto _Abort_Set_SSID;
 228        memcpy(&pmlmepriv->assoc_ssid, ssid, sizeof(struct ndis_802_11_ssid));
 229        pmlmepriv->assoc_by_bssid = false;
 230        do_join(padapter);
 231        goto done;
 232_Abort_Set_SSID:
 233done:
 234        spin_unlock_irqrestore(&pmlmepriv->lock, irqL);
 235}
 236
 237void r8712_set_802_11_infrastructure_mode(struct _adapter *padapter,
 238        enum NDIS_802_11_NETWORK_INFRASTRUCTURE networktype)
 239{
 240        unsigned long irqL;
 241        struct mlme_priv        *pmlmepriv = &padapter->mlmepriv;
 242        struct wlan_network     *cur_network = &pmlmepriv->cur_network;
 243        enum NDIS_802_11_NETWORK_INFRASTRUCTURE *pold_state =
 244                                &(cur_network->network.InfrastructureMode);
 245
 246        if (*pold_state != networktype) {
 247                spin_lock_irqsave(&pmlmepriv->lock, irqL);
 248                if (check_fwstate(pmlmepriv, _FW_LINKED) ||
 249                    (*pold_state == Ndis802_11IBSS))
 250                        r8712_disassoc_cmd(padapter);
 251                if (check_fwstate(pmlmepriv,
 252                    _FW_LINKED | WIFI_ADHOC_MASTER_STATE))
 253                        r8712_free_assoc_resources(padapter);
 254                if (check_fwstate(pmlmepriv, _FW_LINKED) ||
 255                    (*pold_state == Ndis802_11Infrastructure) ||
 256                    (*pold_state == Ndis802_11IBSS)) {
 257                        /* will clr Linked_state before this function,
 258                         * we must have checked whether issue dis-assoc_cmd or
 259                         * not
 260                         */
 261                        r8712_ind_disconnect(padapter);
 262                }
 263                *pold_state = networktype;
 264                /* clear WIFI_STATION_STATE; WIFI_AP_STATE; WIFI_ADHOC_STATE;
 265                 * WIFI_ADHOC_MASTER_STATE
 266                 */
 267                _clr_fwstate_(pmlmepriv, WIFI_STATION_STATE | WIFI_AP_STATE |
 268                              WIFI_ADHOC_STATE | WIFI_ADHOC_MASTER_STATE);
 269                switch (networktype) {
 270                case Ndis802_11IBSS:
 271                        set_fwstate(pmlmepriv, WIFI_ADHOC_STATE);
 272                        break;
 273                case Ndis802_11Infrastructure:
 274                        set_fwstate(pmlmepriv, WIFI_STATION_STATE);
 275                        break;
 276                case Ndis802_11APMode:
 277                        set_fwstate(pmlmepriv, WIFI_AP_STATE);
 278                        break;
 279                case Ndis802_11AutoUnknown:
 280                case Ndis802_11InfrastructureMax:
 281                        break;
 282                }
 283                spin_unlock_irqrestore(&pmlmepriv->lock, irqL);
 284        }
 285}
 286
 287u8 r8712_set_802_11_disassociate(struct _adapter *padapter)
 288{
 289        unsigned long irqL;
 290        struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
 291
 292        spin_lock_irqsave(&pmlmepriv->lock, irqL);
 293        if (check_fwstate(pmlmepriv, _FW_LINKED)) {
 294                r8712_disassoc_cmd(padapter);
 295                r8712_ind_disconnect(padapter);
 296                r8712_free_assoc_resources(padapter);
 297        }
 298        spin_unlock_irqrestore(&pmlmepriv->lock, irqL);
 299        return true;
 300}
 301
 302u8 r8712_set_802_11_bssid_list_scan(struct _adapter *padapter)
 303{
 304        struct mlme_priv *pmlmepriv = NULL;
 305        unsigned long irqL;
 306        u8 ret = true;
 307
 308        if (!padapter)
 309                return false;
 310        pmlmepriv = &padapter->mlmepriv;
 311        if (!padapter->hw_init_completed)
 312                return false;
 313        spin_lock_irqsave(&pmlmepriv->lock, irqL);
 314        if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY | _FW_UNDER_LINKING) ||
 315            pmlmepriv->sitesurveyctrl.traffic_busy) {
 316                /* Scan or linking is in progress, do nothing. */
 317                ret = (u8)check_fwstate(pmlmepriv, _FW_UNDER_SURVEY);
 318        } else {
 319                r8712_free_network_queue(padapter);
 320                ret = r8712_sitesurvey_cmd(padapter, NULL);
 321        }
 322        spin_unlock_irqrestore(&pmlmepriv->lock, irqL);
 323        return ret;
 324}
 325
 326u8 r8712_set_802_11_authentication_mode(struct _adapter *padapter,
 327                                enum NDIS_802_11_AUTHENTICATION_MODE authmode)
 328{
 329        struct security_priv *psecuritypriv = &padapter->securitypriv;
 330        u8 ret;
 331
 332        psecuritypriv->ndisauthtype = authmode;
 333        if (psecuritypriv->ndisauthtype > 3)
 334                psecuritypriv->AuthAlgrthm = 2; /* 802.1x */
 335        if (r8712_set_auth(padapter, psecuritypriv) == _SUCCESS)
 336                ret = true;
 337        else
 338                ret = false;
 339        return ret;
 340}
 341
 342u8 r8712_set_802_11_add_wep(struct _adapter *padapter,
 343                            struct NDIS_802_11_WEP *wep)
 344{
 345        sint    keyid;
 346        struct security_priv *psecuritypriv = &padapter->securitypriv;
 347
 348        keyid = wep->KeyIndex & 0x3fffffff;
 349        if (keyid >= WEP_KEYS)
 350                return false;
 351        switch (wep->KeyLength) {
 352        case 5:
 353                psecuritypriv->PrivacyAlgrthm = _WEP40_;
 354                break;
 355        case 13:
 356                psecuritypriv->PrivacyAlgrthm = _WEP104_;
 357                break;
 358        default:
 359                psecuritypriv->PrivacyAlgrthm = _NO_PRIVACY_;
 360                break;
 361        }
 362        memcpy(psecuritypriv->DefKey[keyid].skey, &wep->KeyMaterial,
 363                wep->KeyLength);
 364        psecuritypriv->DefKeylen[keyid] = wep->KeyLength;
 365        psecuritypriv->PrivacyKeyIndex = keyid;
 366        if (r8712_set_key(padapter, psecuritypriv, keyid) == _FAIL)
 367                return false;
 368        return _SUCCESS;
 369}
 370