1 // SPDX-License-Identifier: GPL-2.0 2 /****************************************************************************** 3 * 4 * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. 5 * 6 ******************************************************************************/ 7 #define _RTW_IOCTL_SET_C_ 8 9 #include <drv_types.h> 10 #include <rtw_debug.h> 11 12 u8 rtw_validate_bssid(u8 *bssid) 13 { 14 u8 ret = true; 15 16 if (is_zero_mac_addr(bssid) 17 || is_broadcast_mac_addr(bssid) 18 || is_multicast_mac_addr(bssid) 19 ) { 20 ret = false; 21 } 22 23 return ret; 24 } 25 26 u8 rtw_validate_ssid(struct ndis_802_11_ssid *ssid) 27 { 28 u8 ret = true; 29 30 if (ssid->SsidLength > 32) { 31 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("ssid length >32\n")); 32 ret = false; 33 goto exit; 34 } 35 36 #ifdef CONFIG_VALIDATE_SSID 37 for (i = 0; i < ssid->SsidLength; i++) { 38 /* wifi, printable ascii code must be supported */ 39 if (!((ssid->Ssid[i] >= 0x20) && (ssid->Ssid[i] <= 0x7e))) { 40 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("ssid has non-printable ascii\n")); 41 ret = false; 42 break; 43 } 44 } 45 #endif /* CONFIG_VALIDATE_SSID */ 46 47 exit: 48 return ret; 49 } 50 51 u8 rtw_do_join(struct adapter *padapter); 52 u8 rtw_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 u8 ret = _SUCCESS; 59 60 spin_lock_bh(&(pmlmepriv->scanned_queue.lock)); 61 phead = get_list_head(queue); 62 plist = get_next(phead); 63 64 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("\n rtw_do_join: phead = %p; plist = %p\n\n\n", phead, plist)); 65 66 pmlmepriv->cur_network.join_res = -2; 67 68 set_fwstate(pmlmepriv, _FW_UNDER_LINKING); 69 70 pmlmepriv->pscanned = plist; 71 72 pmlmepriv->to_join = true; 73 74 if (list_empty(&queue->queue)) { 75 spin_unlock_bh(&(pmlmepriv->scanned_queue.lock)); 76 _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); 77 78 /* when set_ssid/set_bssid for rtw_do_join(), but scanning queue is empty */ 79 /* we try to issue sitesurvey firstly */ 80 81 if (pmlmepriv->LinkDetectInfo.bBusyTraffic == false 82 || rtw_to_roam(padapter) > 0 83 ) { 84 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("rtw_do_join(): site survey if scanned_queue is empty\n.")); 85 /* submit site_survey_cmd */ 86 ret = rtw_sitesurvey_cmd(padapter, &pmlmepriv->assoc_ssid, 1, NULL, 0); 87 if (_SUCCESS != ret) { 88 pmlmepriv->to_join = false; 89 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("rtw_do_join(): site survey return error\n.")); 90 } 91 } else { 92 pmlmepriv->to_join = false; 93 ret = _FAIL; 94 } 95 96 goto exit; 97 } else { 98 int select_ret; 99 spin_unlock_bh(&(pmlmepriv->scanned_queue.lock)); 100 select_ret = rtw_select_and_join_from_scanned_queue(pmlmepriv); 101 if (select_ret == _SUCCESS) { 102 pmlmepriv->to_join = false; 103 _set_timer(&pmlmepriv->assoc_timer, MAX_JOIN_TIMEOUT); 104 } else { 105 if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == true) { 106 /* submit createbss_cmd to change to a ADHOC_MASTER */ 107 108 /* pmlmepriv->lock has been acquired by caller... */ 109 struct wlan_bssid_ex *pdev_network = &(padapter->registrypriv.dev_network); 110 111 pmlmepriv->fw_state = WIFI_ADHOC_MASTER_STATE; 112 113 pibss = padapter->registrypriv.dev_network.MacAddress; 114 115 memcpy(&pdev_network->Ssid, &pmlmepriv->assoc_ssid, sizeof(struct ndis_802_11_ssid)); 116 117 rtw_update_registrypriv_dev_network(padapter); 118 119 rtw_generate_random_ibss(pibss); 120 121 if (rtw_createbss_cmd(padapter) != _SUCCESS) { 122 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("***Error =>do_goin: rtw_createbss_cmd status FAIL***\n ")); 123 ret = false; 124 goto exit; 125 } 126 127 pmlmepriv->to_join = false; 128 129 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("***Error => rtw_select_and_join_from_scanned_queue FAIL under STA_Mode***\n ")); 130 131 } else { 132 /* can't associate ; reset under-linking */ 133 _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); 134 135 /* when set_ssid/set_bssid for rtw_do_join(), but there are no desired bss in scanning queue */ 136 /* we try to issue sitesurvey firstly */ 137 if (pmlmepriv->LinkDetectInfo.bBusyTraffic == false 138 || rtw_to_roam(padapter) > 0 139 ) { 140 /* DBG_871X("rtw_do_join() when no desired bss in scanning queue\n"); */ 141 ret = rtw_sitesurvey_cmd(padapter, &pmlmepriv->assoc_ssid, 1, NULL, 0); 142 if (_SUCCESS != ret) { 143 pmlmepriv->to_join = false; 144 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("do_join(): site survey return error\n.")); 145 } 146 } else { 147 ret = _FAIL; 148 pmlmepriv->to_join = false; 149 } 150 } 151 152 } 153 154 } 155 156 exit: 157 return ret; 158 } 159 160 u8 rtw_set_802_11_bssid(struct adapter *padapter, u8 *bssid) 161 { 162 u8 status = _SUCCESS; 163 164 struct mlme_priv *pmlmepriv = &padapter->mlmepriv; 165 166 DBG_871X_LEVEL(_drv_always_, "set bssid:%pM\n", bssid); 167 168 if ((bssid[0] == 0x00 && bssid[1] == 0x00 && bssid[2] == 0x00 && bssid[3] == 0x00 && bssid[4] == 0x00 && bssid[5] == 0x00) || 169 (bssid[0] == 0xFF && bssid[1] == 0xFF && bssid[2] == 0xFF && bssid[3] == 0xFF && bssid[4] == 0xFF && bssid[5] == 0xFF)) { 170 status = _FAIL; 171 goto exit; 172 } 173 174 spin_lock_bh(&pmlmepriv->lock); 175 176 177 DBG_871X("Set BSSID under fw_state = 0x%08x\n", get_fwstate(pmlmepriv)); 178 if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == true) 179 goto handle_tkip_countermeasure; 180 else if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == true) 181 goto release_mlme_lock; 182 183 if (check_fwstate(pmlmepriv, _FW_LINKED|WIFI_ADHOC_MASTER_STATE) == true) { 184 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("set_bssid: _FW_LINKED||WIFI_ADHOC_MASTER_STATE\n")); 185 186 if (!memcmp(&pmlmepriv->cur_network.network.MacAddress, bssid, ETH_ALEN)) { 187 if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == false) 188 goto release_mlme_lock;/* it means driver is in WIFI_ADHOC_MASTER_STATE, we needn't create bss again. */ 189 } else { 190 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("Set BSSID not the same bssid\n")); 191 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("set_bssid =%pM\n", MAC_ARG(bssid))); 192 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("cur_bssid =%pM\n", MAC_ARG(pmlmepriv->cur_network.network.MacAddress))); 193 194 rtw_disassoc_cmd(padapter, 0, true); 195 196 if (check_fwstate(pmlmepriv, _FW_LINKED) == true) 197 rtw_indicate_disconnect(padapter); 198 199 rtw_free_assoc_resources(padapter, 1); 200 201 if ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == true)) { 202 _clr_fwstate_(pmlmepriv, WIFI_ADHOC_MASTER_STATE); 203 set_fwstate(pmlmepriv, WIFI_ADHOC_STATE); 204 } 205 } 206 } 207 208 handle_tkip_countermeasure: 209 if (rtw_handle_tkip_countermeasure(padapter, __func__) == _FAIL) { 210 status = _FAIL; 211 goto release_mlme_lock; 212 } 213 214 memset(&pmlmepriv->assoc_ssid, 0, sizeof(struct ndis_802_11_ssid)); 215 memcpy(&pmlmepriv->assoc_bssid, bssid, ETH_ALEN); 216 pmlmepriv->assoc_by_bssid = true; 217 218 if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == true) 219 pmlmepriv->to_join = true; 220 else 221 status = rtw_do_join(padapter); 222 223 release_mlme_lock: 224 spin_unlock_bh(&pmlmepriv->lock); 225 226 exit: 227 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, 228 ("rtw_set_802_11_bssid: status =%d\n", status)); 229 230 return status; 231 } 232 233 u8 rtw_set_802_11_ssid(struct adapter *padapter, struct ndis_802_11_ssid *ssid) 234 { 235 u8 status = _SUCCESS; 236 237 struct mlme_priv *pmlmepriv = &padapter->mlmepriv; 238 struct wlan_network *pnetwork = &pmlmepriv->cur_network; 239 240 DBG_871X_LEVEL(_drv_always_, "set ssid [%s] fw_state = 0x%08x\n", 241 ssid->Ssid, get_fwstate(pmlmepriv)); 242 243 if (padapter->hw_init_completed == false) { 244 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, 245 ("set_ssid: hw_init_completed ==false =>exit!!!\n")); 246 status = _FAIL; 247 goto exit; 248 } 249 250 spin_lock_bh(&pmlmepriv->lock); 251 252 DBG_871X("Set SSID under fw_state = 0x%08x\n", get_fwstate(pmlmepriv)); 253 if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == true) 254 goto handle_tkip_countermeasure; 255 else if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == true) 256 goto release_mlme_lock; 257 258 if (check_fwstate(pmlmepriv, _FW_LINKED|WIFI_ADHOC_MASTER_STATE) == true) { 259 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, 260 ("set_ssid: _FW_LINKED||WIFI_ADHOC_MASTER_STATE\n")); 261 262 if ((pmlmepriv->assoc_ssid.SsidLength == ssid->SsidLength) && 263 (!memcmp(&pmlmepriv->assoc_ssid.Ssid, ssid->Ssid, ssid->SsidLength))) { 264 if ((check_fwstate(pmlmepriv, WIFI_STATION_STATE) == false)) { 265 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, 266 ("Set SSID is the same ssid, fw_state = 0x%08x\n", 267 get_fwstate(pmlmepriv))); 268 269 if (rtw_is_same_ibss(padapter, pnetwork) == false) { 270 /* if in WIFI_ADHOC_MASTER_STATE | WIFI_ADHOC_STATE, create bss or rejoin again */ 271 rtw_disassoc_cmd(padapter, 0, true); 272 273 if (check_fwstate(pmlmepriv, _FW_LINKED) == true) 274 rtw_indicate_disconnect(padapter); 275 276 rtw_free_assoc_resources(padapter, 1); 277 278 if (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == true) { 279 _clr_fwstate_(pmlmepriv, WIFI_ADHOC_MASTER_STATE); 280 set_fwstate(pmlmepriv, WIFI_ADHOC_STATE); 281 } 282 } else { 283 goto release_mlme_lock;/* it means driver is in WIFI_ADHOC_MASTER_STATE, we needn't create bss again. */ 284 } 285 } else { 286 rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_JOINBSS, 1); 287 } 288 } else { 289 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("Set SSID not the same ssid\n")); 290 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("set_ssid =[%s] len = 0x%x\n", ssid->Ssid, (unsigned int)ssid->SsidLength)); 291 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("assoc_ssid =[%s] len = 0x%x\n", pmlmepriv->assoc_ssid.Ssid, (unsigned int)pmlmepriv->assoc_ssid.SsidLength)); 292 293 rtw_disassoc_cmd(padapter, 0, true); 294 295 if (check_fwstate(pmlmepriv, _FW_LINKED) == true) 296 rtw_indicate_disconnect(padapter); 297 298 rtw_free_assoc_resources(padapter, 1); 299 300 if (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == true) { 301 _clr_fwstate_(pmlmepriv, WIFI_ADHOC_MASTER_STATE); 302 set_fwstate(pmlmepriv, WIFI_ADHOC_STATE); 303 } 304 } 305 } 306 307 handle_tkip_countermeasure: 308 if (rtw_handle_tkip_countermeasure(padapter, __func__) == _FAIL) { 309 status = _FAIL; 310 goto release_mlme_lock; 311 } 312 313 if (rtw_validate_ssid(ssid) == false) { 314 status = _FAIL; 315 goto release_mlme_lock; 316 } 317 318 memcpy(&pmlmepriv->assoc_ssid, ssid, sizeof(struct ndis_802_11_ssid)); 319 pmlmepriv->assoc_by_bssid = false; 320 321 if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == true) 322 pmlmepriv->to_join = true; 323 else 324 status = rtw_do_join(padapter); 325 326 release_mlme_lock: 327 spin_unlock_bh(&pmlmepriv->lock); 328 329 exit: 330 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, 331 ("-rtw_set_802_11_ssid: status =%d\n", status)); 332 333 return status; 334 } 335 336 u8 rtw_set_802_11_connect(struct adapter *padapter, u8 *bssid, struct ndis_802_11_ssid *ssid) 337 { 338 u8 status = _SUCCESS; 339 bool bssid_valid = true; 340 bool ssid_valid = true; 341 struct mlme_priv *pmlmepriv = &padapter->mlmepriv; 342 343 if (!ssid || rtw_validate_ssid(ssid) == false) 344 ssid_valid = false; 345 346 if (!bssid || rtw_validate_bssid(bssid) == false) 347 bssid_valid = false; 348 349 if (!ssid_valid && !bssid_valid) { 350 DBG_871X(FUNC_ADPT_FMT" ssid:%p, ssid_valid:%d, bssid:%p, bssid_valid:%d\n", 351 FUNC_ADPT_ARG(padapter), ssid, ssid_valid, bssid, bssid_valid); 352 status = _FAIL; 353 goto exit; 354 } 355 356 if (padapter->hw_init_completed == false) { 357 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, 358 ("set_ssid: hw_init_completed ==false =>exit!!!\n")); 359 status = _FAIL; 360 goto exit; 361 } 362 363 spin_lock_bh(&pmlmepriv->lock); 364 365 DBG_871X_LEVEL(_drv_always_, FUNC_ADPT_FMT" fw_state = 0x%08x\n", 366 FUNC_ADPT_ARG(padapter), get_fwstate(pmlmepriv)); 367 368 if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == true) 369 goto handle_tkip_countermeasure; 370 else if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == true) 371 goto release_mlme_lock; 372 373 handle_tkip_countermeasure: 374 if (rtw_handle_tkip_countermeasure(padapter, __func__) == _FAIL) { 375 status = _FAIL; 376 goto release_mlme_lock; 377 } 378 379 if (ssid && ssid_valid) 380 memcpy(&pmlmepriv->assoc_ssid, ssid, sizeof(struct ndis_802_11_ssid)); 381 else 382 memset(&pmlmepriv->assoc_ssid, 0, sizeof(struct ndis_802_11_ssid)); 383 384 if (bssid && bssid_valid) { 385 memcpy(&pmlmepriv->assoc_bssid, bssid, ETH_ALEN); 386 pmlmepriv->assoc_by_bssid = true; 387 } else { 388 pmlmepriv->assoc_by_bssid = false; 389 } 390 391 if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == true) 392 pmlmepriv->to_join = true; 393 else 394 status = rtw_do_join(padapter); 395 396 release_mlme_lock: 397 spin_unlock_bh(&pmlmepriv->lock); 398 399 exit: 400 return status; 401 } 402 403 u8 rtw_set_802_11_infrastructure_mode(struct adapter *padapter, 404 enum NDIS_802_11_NETWORK_INFRASTRUCTURE networktype) 405 { 406 struct mlme_priv *pmlmepriv = &padapter->mlmepriv; 407 struct wlan_network *cur_network = &pmlmepriv->cur_network; 408 enum NDIS_802_11_NETWORK_INFRASTRUCTURE *pold_state = &(cur_network->network.InfrastructureMode); 409 410 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_notice_, 411 ("+rtw_set_802_11_infrastructure_mode: old =%d new =%d fw_state = 0x%08x\n", 412 *pold_state, networktype, get_fwstate(pmlmepriv))); 413 414 if (*pold_state != networktype) { 415 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, (" change mode!")); 416 /* DBG_871X("change mode, old_mode =%d, new_mode =%d, fw_state = 0x%x\n", *pold_state, networktype, get_fwstate(pmlmepriv)); */ 417 418 if (*pold_state == Ndis802_11APMode) { 419 /* change to other mode from Ndis802_11APMode */ 420 cur_network->join_res = -1; 421 422 stop_ap_mode(padapter); 423 } 424 425 spin_lock_bh(&pmlmepriv->lock); 426 427 if ((check_fwstate(pmlmepriv, _FW_LINKED) == true) || (*pold_state == Ndis802_11IBSS)) 428 rtw_disassoc_cmd(padapter, 0, true); 429 430 if ((check_fwstate(pmlmepriv, _FW_LINKED) == true) || 431 (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == true)) 432 rtw_free_assoc_resources(padapter, 1); 433 434 if ((*pold_state == Ndis802_11Infrastructure) || (*pold_state == Ndis802_11IBSS)) { 435 if (check_fwstate(pmlmepriv, _FW_LINKED) == true) 436 rtw_indicate_disconnect(padapter); /* will clr Linked_state; before this function, we must have checked whether issue dis-assoc_cmd or not */ 437 } 438 439 *pold_state = networktype; 440 441 _clr_fwstate_(pmlmepriv, ~WIFI_NULL_STATE); 442 443 switch (networktype) { 444 case Ndis802_11IBSS: 445 set_fwstate(pmlmepriv, WIFI_ADHOC_STATE); 446 break; 447 448 case Ndis802_11Infrastructure: 449 set_fwstate(pmlmepriv, WIFI_STATION_STATE); 450 break; 451 452 case Ndis802_11APMode: 453 set_fwstate(pmlmepriv, WIFI_AP_STATE); 454 start_ap_mode(padapter); 455 /* rtw_indicate_connect(padapter); */ 456 457 break; 458 459 case Ndis802_11AutoUnknown: 460 case Ndis802_11InfrastructureMax: 461 break; 462 } 463 464 /* SecClearAllKeys(adapter); */ 465 466 /* RT_TRACE(COMP_OID_SET, DBG_LOUD, ("set_infrastructure: fw_state:%x after changing mode\n", */ 467 /* get_fwstate(pmlmepriv))); */ 468 469 spin_unlock_bh(&pmlmepriv->lock); 470 } 471 return true; 472 } 473 474 475 u8 rtw_set_802_11_disassociate(struct adapter *padapter) 476 { 477 struct mlme_priv *pmlmepriv = &padapter->mlmepriv; 478 479 spin_lock_bh(&pmlmepriv->lock); 480 481 if (check_fwstate(pmlmepriv, _FW_LINKED) == true) { 482 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("MgntActrtw_set_802_11_disassociate: rtw_indicate_disconnect\n")); 483 484 rtw_disassoc_cmd(padapter, 0, true); 485 rtw_indicate_disconnect(padapter); 486 /* modify for CONFIG_IEEE80211W, none 11w can use it */ 487 rtw_free_assoc_resources_cmd(padapter); 488 if (_FAIL == rtw_pwr_wakeup(padapter)) 489 DBG_871X("%s(): rtw_pwr_wakeup fail !!!\n", __func__); 490 } 491 492 spin_unlock_bh(&pmlmepriv->lock); 493 494 return true; 495 } 496 497 u8 rtw_set_802_11_bssid_list_scan(struct adapter *padapter, struct ndis_802_11_ssid *pssid, int ssid_max_num) 498 { 499 struct mlme_priv *pmlmepriv = &padapter->mlmepriv; 500 u8 res = true; 501 502 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("+rtw_set_802_11_bssid_list_scan(), fw_state =%x\n", get_fwstate(pmlmepriv))); 503 504 if (padapter == NULL) { 505 res = false; 506 goto exit; 507 } 508 if (padapter->hw_init_completed == false) { 509 res = false; 510 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("\n ===rtw_set_802_11_bssid_list_scan:hw_init_completed ==false ===\n")); 511 goto exit; 512 } 513 514 if ((check_fwstate(pmlmepriv, _FW_UNDER_SURVEY|_FW_UNDER_LINKING) == true) || 515 (pmlmepriv->LinkDetectInfo.bBusyTraffic == true)) { 516 /* Scan or linking is in progress, do nothing. */ 517 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("rtw_set_802_11_bssid_list_scan fail since fw_state = %x\n", get_fwstate(pmlmepriv))); 518 res = true; 519 520 if (check_fwstate(pmlmepriv, (_FW_UNDER_SURVEY|_FW_UNDER_LINKING)) == true) 521 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("\n###_FW_UNDER_SURVEY|_FW_UNDER_LINKING\n\n")); 522 else 523 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("\n###pmlmepriv->sitesurveyctrl.traffic_busy ==true\n\n")); 524 } else { 525 if (rtw_is_scan_deny(padapter)) { 526 DBG_871X(FUNC_ADPT_FMT": scan deny\n", FUNC_ADPT_ARG(padapter)); 527 indicate_wx_scan_complete_event(padapter); 528 return _SUCCESS; 529 } 530 531 spin_lock_bh(&pmlmepriv->lock); 532 533 res = rtw_sitesurvey_cmd(padapter, pssid, ssid_max_num, NULL, 0); 534 535 spin_unlock_bh(&pmlmepriv->lock); 536 } 537 exit: 538 539 return res; 540 } 541 542 u8 rtw_set_802_11_authentication_mode(struct adapter *padapter, enum NDIS_802_11_AUTHENTICATION_MODE authmode) 543 { 544 struct security_priv *psecuritypriv = &padapter->securitypriv; 545 int res; 546 u8 ret; 547 548 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("set_802_11_auth.mode(): mode =%x\n", authmode)); 549 550 psecuritypriv->ndisauthtype = authmode; 551 552 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("rtw_set_802_11_authentication_mode:psecuritypriv->ndisauthtype =%d", psecuritypriv->ndisauthtype)); 553 554 if (psecuritypriv->ndisauthtype > 3) 555 psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; 556 557 res = rtw_set_auth(padapter, psecuritypriv); 558 559 if (res == _SUCCESS) 560 ret = true; 561 else 562 ret = false; 563 564 return ret; 565 } 566 567 u8 rtw_set_802_11_add_wep(struct adapter *padapter, struct ndis_802_11_wep *wep) 568 { 569 570 sint keyid, res; 571 struct security_priv *psecuritypriv = &(padapter->securitypriv); 572 u8 ret = _SUCCESS; 573 574 keyid = wep->KeyIndex & 0x3fffffff; 575 576 if (keyid >= 4) { 577 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("MgntActrtw_set_802_11_add_wep:keyid>4 =>fail\n")); 578 ret = false; 579 goto exit; 580 } 581 582 switch (wep->KeyLength) { 583 case 5: 584 psecuritypriv->dot11PrivacyAlgrthm = _WEP40_; 585 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("MgntActrtw_set_802_11_add_wep:wep->KeyLength =5\n")); 586 break; 587 case 13: 588 psecuritypriv->dot11PrivacyAlgrthm = _WEP104_; 589 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("MgntActrtw_set_802_11_add_wep:wep->KeyLength = 13\n")); 590 break; 591 default: 592 psecuritypriv->dot11PrivacyAlgrthm = _NO_PRIVACY_; 593 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("MgntActrtw_set_802_11_add_wep:wep->KeyLength!=5 or 13\n")); 594 break; 595 } 596 597 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, 598 ("rtw_set_802_11_add_wep:before memcpy, wep->KeyLength = 0x%x wep->KeyIndex = 0x%x keyid =%x\n", 599 wep->KeyLength, wep->KeyIndex, keyid)); 600 601 memcpy(&(psecuritypriv->dot11DefKey[keyid].skey[0]), &(wep->KeyMaterial), wep->KeyLength); 602 603 psecuritypriv->dot11DefKeylen[keyid] = wep->KeyLength; 604 605 psecuritypriv->dot11PrivacyKeyIndex = keyid; 606 607 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("rtw_set_802_11_add_wep:security key material : %x %x %x %x %x %x %x %x %x %x %x %x %x\n", 608 psecuritypriv->dot11DefKey[keyid].skey[0], psecuritypriv->dot11DefKey[keyid].skey[1], psecuritypriv->dot11DefKey[keyid].skey[2], 609 psecuritypriv->dot11DefKey[keyid].skey[3], psecuritypriv->dot11DefKey[keyid].skey[4], psecuritypriv->dot11DefKey[keyid].skey[5], 610 psecuritypriv->dot11DefKey[keyid].skey[6], psecuritypriv->dot11DefKey[keyid].skey[7], psecuritypriv->dot11DefKey[keyid].skey[8], 611 psecuritypriv->dot11DefKey[keyid].skey[9], psecuritypriv->dot11DefKey[keyid].skey[10], psecuritypriv->dot11DefKey[keyid].skey[11], 612 psecuritypriv->dot11DefKey[keyid].skey[12])); 613 614 res = rtw_set_key(padapter, psecuritypriv, keyid, 1, true); 615 616 if (res == _FAIL) 617 ret = false; 618 exit: 619 620 return ret; 621 } 622 623 /* 624 * rtw_get_cur_max_rate - 625 * @adapter: pointer to struct adapter structure 626 * 627 * Return 0 or 100Kbps 628 */ 629 u16 rtw_get_cur_max_rate(struct adapter *adapter) 630 { 631 int i = 0; 632 u16 rate = 0, max_rate = 0; 633 struct mlme_priv *pmlmepriv = &adapter->mlmepriv; 634 struct wlan_bssid_ex *pcur_bss = &pmlmepriv->cur_network.network; 635 struct sta_info *psta = NULL; 636 u8 short_GI = 0; 637 u8 rf_type = 0; 638 639 if ((check_fwstate(pmlmepriv, _FW_LINKED) != true) 640 && (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) != true)) 641 return 0; 642 643 psta = rtw_get_stainfo(&adapter->stapriv, get_bssid(pmlmepriv)); 644 if (psta == NULL) 645 return 0; 646 647 short_GI = query_ra_short_GI(psta); 648 649 if (IsSupportedHT(psta->wireless_mode)) { 650 rtw_hal_get_hwreg(adapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); 651 652 max_rate = rtw_mcs_rate(rf_type, 653 ((psta->bw_mode == CHANNEL_WIDTH_40)?1:0), 654 short_GI, 655 psta->htpriv.ht_cap.mcs.rx_mask); 656 } else { 657 while ((pcur_bss->SupportedRates[i] != 0) && (pcur_bss->SupportedRates[i] != 0xFF)) { 658 rate = pcur_bss->SupportedRates[i]&0x7F; 659 if (rate > max_rate) 660 max_rate = rate; 661 i++; 662 } 663 664 max_rate = max_rate*10/2; 665 } 666 667 return max_rate; 668 } 669