drivers/staging/rtl8723au/core/rtw_wlan_util.c

   1 /******************************************************************************
   2  *
   3  * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved.
   4  *
   5  * This program is free software; you can redistribute it and/or modify it
   6  * under the terms of version 2 of the GNU General Public License as
   7  * published by the Free Software Foundation.
   8  *
   9  * This program is distributed in the hope that it will be useful, but WITHOUT
  10  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  11  * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
  12  * more details.
  13  *
  14  ******************************************************************************/
  15 #define _RTW_WLAN_UTIL_C_
  16
  17 #include <osdep_service.h>
  18 #include <drv_types.h>
  19 #include <linux/ieee80211.h>
  20 #include <wifi.h>
  21
  22 static unsigned char ARTHEROS_OUI1[] = {0x00, 0x03, 0x7f};
  23 static unsigned char ARTHEROS_OUI2[] = {0x00, 0x13, 0x74};
  24
  25 static unsigned char BROADCOM_OUI1[] = {0x00, 0x10, 0x18};
  26 static unsigned char BROADCOM_OUI2[] = {0x00, 0x0a, 0xf7};
  27
  28 static unsigned char CISCO_OUI[] = {0x00, 0x40, 0x96};
  29 static unsigned char MARVELL_OUI[] = {0x00, 0x50, 0x43};
  30 static unsigned char RALINK_OUI[] = {0x00, 0x0c, 0x43};
  31 static unsigned char REALTEK_OUI[] = {0x00, 0xe0, 0x4c};
  32 static unsigned char AIRGOCAP_OUI[] = {0x00, 0x0a, 0xf5};
  33 static unsigned char EPIGRAM_OUI[] = {0x00, 0x90, 0x4c};
  34
  35 unsigned char REALTEK_96B_IE23A[] = {0x00, 0xe0, 0x4c, 0x02, 0x01, 0x20};
  36
  37 #define R2T_PHY_DELAY   (0)
  38
  39 /* define WAIT_FOR_BCN_TO_MIN   (3000) */
  40 #define WAIT_FOR_BCN_TO_MIN     (6000)
  41 #define WAIT_FOR_BCN_TO_MAX     (20000)
  42
  43 static u8 rtw_basic_rate_cck[4] = {
  44         IEEE80211_CCK_RATE_1MB|IEEE80211_BASIC_RATE_MASK, IEEE80211_CCK_RATE_2MB|IEEE80211_BASIC_RATE_MASK,
  45         IEEE80211_CCK_RATE_5MB|IEEE80211_BASIC_RATE_MASK, IEEE80211_CCK_RATE_11MB|IEEE80211_BASIC_RATE_MASK
  46 };
  47
  48 static u8 rtw_basic_rate_ofdm[3] = {
  49         IEEE80211_OFDM_RATE_6MB|IEEE80211_BASIC_RATE_MASK, IEEE80211_OFDM_RATE_12MB|IEEE80211_BASIC_RATE_MASK,
  50         IEEE80211_OFDM_RATE_24MB|IEEE80211_BASIC_RATE_MASK
  51 };
  52
  53 static u8 rtw_basic_rate_mix[7] = {
  54         IEEE80211_CCK_RATE_1MB|IEEE80211_BASIC_RATE_MASK, IEEE80211_CCK_RATE_2MB|IEEE80211_BASIC_RATE_MASK,
  55         IEEE80211_CCK_RATE_5MB|IEEE80211_BASIC_RATE_MASK, IEEE80211_CCK_RATE_11MB|IEEE80211_BASIC_RATE_MASK,
  56         IEEE80211_OFDM_RATE_6MB|IEEE80211_BASIC_RATE_MASK, IEEE80211_OFDM_RATE_12MB|IEEE80211_BASIC_RATE_MASK,
  57         IEEE80211_OFDM_RATE_24MB|IEEE80211_BASIC_RATE_MASK
  58 };
  59
  60 int cckrates_included23a(unsigned char *rate, int ratelen)
  61 {
  62         int     i;
  63
  64         for (i = 0; i < ratelen; i++) {
  65                 if  ((((rate[i]) & 0x7f) == 2)  || (((rate[i]) & 0x7f) == 4) ||
  66                      (((rate[i]) & 0x7f) == 11)  || (((rate[i]) & 0x7f) == 22))
  67                         return true;
  68         }
  69
  70         return false;
  71 }
  72
  73 int cckratesonly_included23a(unsigned char *rate, int ratelen)
  74 {
  75         int     i;
  76
  77         for (i = 0; i < ratelen; i++) {
  78                 if  ((((rate[i]) & 0x7f) != 2) && (((rate[i]) & 0x7f) != 4) &&
  79                            (((rate[i]) & 0x7f) != 11)  && (((rate[i]) & 0x7f) != 22))
  80                 return false;
  81         }
  82
  83         return true;
  84 }
  85
  86 unsigned char networktype_to_raid23a(unsigned char network_type)
  87 {
  88         unsigned char raid;
  89
  90         switch (network_type) {
  91         case WIRELESS_11B:
  92                 raid = RATR_INX_WIRELESS_B;
  93                 break;
  94         case WIRELESS_11A:
  95         case WIRELESS_11G:
  96                 raid = RATR_INX_WIRELESS_G;
  97                 break;
  98         case WIRELESS_11BG:
  99                 raid = RATR_INX_WIRELESS_GB;
 100                 break;
 101         case WIRELESS_11_24N:
 102         case WIRELESS_11_5N:
 103                 raid = RATR_INX_WIRELESS_N;
 104                 break;
 105         case WIRELESS_11A_5N:
 106         case WIRELESS_11G_24N:
 107                 raid = RATR_INX_WIRELESS_NG;
 108                 break;
 109         case WIRELESS_11BG_24N:
 110                 raid = RATR_INX_WIRELESS_NGB;
 111                 break;
 112         default:
 113                 raid = RATR_INX_WIRELESS_GB;
 114                 break;
 115         }
 116         return raid;
 117 }
 118
 119 u8 judge_network_type23a(struct rtw_adapter *padapter, unsigned char *rate, int ratelen)
 120 {
 121         u8 network_type = 0;
 122         struct mlme_ext_priv    *pmlmeext = &padapter->mlmeextpriv;
 123         struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
 124
 125         if (pmlmeext->cur_channel > 14) {
 126                 if (pmlmeinfo->HT_enable)
 127                         network_type = WIRELESS_11_5N;
 128                 network_type |= WIRELESS_11A;
 129         } else {
 130                 if (pmlmeinfo->HT_enable)
 131                         network_type = WIRELESS_11_24N;
 132
 133                 if ((cckratesonly_included23a(rate, ratelen)) == true)
 134                         network_type |= WIRELESS_11B;
 135                 else if ((cckrates_included23a(rate, ratelen)) == true)
 136                         network_type |= WIRELESS_11BG;
 137                 else
 138                         network_type |= WIRELESS_11G;
 139         }
 140         return  network_type;
 141 }
 142
 143 unsigned char ratetbl_val_2wifirate(unsigned char rate)
 144 {
 145         unsigned char val = 0;
 146
 147         switch (rate & 0x7f) {
 148         case 0:
 149                 val = IEEE80211_CCK_RATE_1MB;
 150                 break;
 151         case 1:
 152                 val = IEEE80211_CCK_RATE_2MB;
 153                 break;
 154         case 2:
 155                 val = IEEE80211_CCK_RATE_5MB;
 156                 break;
 157         case 3:
 158                 val = IEEE80211_CCK_RATE_11MB;
 159                 break;
 160         case 4:
 161                 val = IEEE80211_OFDM_RATE_6MB;
 162                 break;
 163         case 5:
 164                 val = IEEE80211_OFDM_RATE_9MB;
 165                 break;
 166         case 6:
 167                 val = IEEE80211_OFDM_RATE_12MB;
 168                 break;
 169         case 7:
 170                 val = IEEE80211_OFDM_RATE_18MB;
 171                 break;
 172         case 8:
 173                 val = IEEE80211_OFDM_RATE_24MB;
 174                 break;
 175         case 9:
 176                 val = IEEE80211_OFDM_RATE_36MB;
 177                 break;
 178         case 10:
 179                 val = IEEE80211_OFDM_RATE_48MB;
 180                 break;
 181         case 11:
 182                 val = IEEE80211_OFDM_RATE_54MB;
 183                 break;
 184         }
 185         return val;
 186 }
 187
 188 int is_basicrate(struct rtw_adapter *padapter, unsigned char rate)
 189 {
 190         int i;
 191         unsigned char val;
 192         struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
 193
 194         for (i = 0; i < NumRates; i++) {
 195                 val = pmlmeext->basicrate[i];
 196
 197                 if ((val != 0xff) && (val != 0xfe)) {
 198                         if (rate == ratetbl_val_2wifirate(val))
 199                                 return true;
 200                 }
 201         }
 202
 203         return false;
 204 }
 205
 206 unsigned int ratetbl2rateset(struct rtw_adapter *padapter, unsigned char *rateset)
 207 {
 208         int i;
 209         unsigned char rate;
 210         unsigned int    len = 0;
 211         struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
 212
 213         for (i = 0; i < NumRates; i++) {
 214                 rate = pmlmeext->datarate[i];
 215
 216                 switch (rate) {
 217                 case 0xff:
 218                         return len;
 219                 case 0xfe:
 220                         continue;
 221                 default:
 222                         rate = ratetbl_val_2wifirate(rate);
 223
 224                         if (is_basicrate(padapter, rate) == true)
 225                                 rate |= IEEE80211_BASIC_RATE_MASK;
 226
 227                         rateset[len] = rate;
 228                         len++;
 229                         break;
 230                 }
 231         }
 232         return len;
 233 }
 234
 235 void get_rate_set23a(struct rtw_adapter *padapter, unsigned char *pbssrate, int *bssrate_len)
 236 {
 237         unsigned char supportedrates[NumRates];
 238
 239         memset(supportedrates, 0, NumRates);
 240         *bssrate_len = ratetbl2rateset(padapter, supportedrates);
 241         memcpy(pbssrate, supportedrates, *bssrate_len);
 242 }
 243
 244 void UpdateBrateTbl23a(struct rtw_adapter *Adapter, u8 *mBratesOS)
 245 {
 246         u8      i;
 247         u8      rate;
 248
 249         /*  1M, 2M, 5.5M, 11M, 6M, 12M, 24M are mandatory. */
 250         for (i = 0; i < NDIS_802_11_LENGTH_RATES_EX; i++) {
 251                 rate = mBratesOS[i] & 0x7f;
 252                 switch (rate) {
 253                 case IEEE80211_CCK_RATE_1MB:
 254                 case IEEE80211_CCK_RATE_2MB:
 255                 case IEEE80211_CCK_RATE_5MB:
 256                 case IEEE80211_CCK_RATE_11MB:
 257                 case IEEE80211_OFDM_RATE_6MB:
 258                 case IEEE80211_OFDM_RATE_12MB:
 259                 case IEEE80211_OFDM_RATE_24MB:
 260                         mBratesOS[i] |= IEEE80211_BASIC_RATE_MASK;
 261                         break;
 262                 default:
 263                         break;
 264                 }
 265         }
 266 }
 267
 268 void Update23aTblForSoftAP(u8 *bssrateset, u32 bssratelen)
 269 {
 270         u8      i;
 271         u8      rate;
 272
 273         for (i = 0; i < bssratelen; i++) {
 274                 rate = bssrateset[i] & 0x7f;
 275                 switch (rate) {
 276                 case IEEE80211_CCK_RATE_1MB:
 277                 case IEEE80211_CCK_RATE_2MB:
 278                 case IEEE80211_CCK_RATE_5MB:
 279                 case IEEE80211_CCK_RATE_11MB:
 280                         bssrateset[i] |= IEEE80211_BASIC_RATE_MASK;
 281                         break;
 282                 }
 283         }
 284 }
 285
 286 void Set_MSR23a(struct rtw_adapter *padapter, u8 type)
 287 {
 288         rtl8723a_set_media_status(padapter, type);
 289 }
 290
 291 inline u8 rtw_get_oper_ch23a(struct rtw_adapter *adapter)
 292 {
 293         return adapter_to_dvobj(adapter)->oper_channel;
 294 }
 295
 296 inline void rtw_set_oper_ch23a(struct rtw_adapter *adapter, u8 ch)
 297 {
 298         adapter_to_dvobj(adapter)->oper_channel = ch;
 299 }
 300
 301 inline u8 rtw_get_oper_bw23a(struct rtw_adapter *adapter)
 302 {
 303         return adapter_to_dvobj(adapter)->oper_bwmode;
 304 }
 305
 306 inline void rtw_set_oper_bw23a(struct rtw_adapter *adapter, u8 bw)
 307 {
 308         adapter_to_dvobj(adapter)->oper_bwmode = bw;
 309 }
 310
 311 inline u8 rtw_get_oper_ch23aoffset(struct rtw_adapter *adapter)
 312 {
 313         return adapter_to_dvobj(adapter)->oper_ch_offset;
 314 }
 315
 316 inline void rtw_set_oper_ch23aoffset23a(struct rtw_adapter *adapter, u8 offset)
 317 {
 318         adapter_to_dvobj(adapter)->oper_ch_offset = offset;
 319 }
 320
 321 void SelectChannel23a(struct rtw_adapter *padapter, unsigned char channel)
 322 {
 323         mutex_lock(&adapter_to_dvobj(padapter)->setch_mutex);
 324
 325         /* saved channel info */
 326         rtw_set_oper_ch23a(padapter, channel);
 327
 328         rtw_hal_set_chan23a(padapter, channel);
 329
 330         mutex_unlock(&adapter_to_dvobj(padapter)->setch_mutex);
 331 }
 332
 333 void SetBWMode23a(struct rtw_adapter *padapter, unsigned short bwmode, unsigned char channel_offset)
 334 {
 335         mutex_lock(&adapter_to_dvobj(padapter)->setbw_mutex);
 336
 337         /* saved bw info */
 338         rtw_set_oper_bw23a(padapter, bwmode);
 339         rtw_set_oper_ch23aoffset23a(padapter, channel_offset);
 340
 341         rtw_hal_set_bwmode23a(padapter, (enum ht_channel_width)bwmode,
 342                            channel_offset);
 343
 344         mutex_unlock(&adapter_to_dvobj(padapter)->setbw_mutex);
 345 }
 346
 347 void set_channel_bwmode23a(struct rtw_adapter *padapter, unsigned char channel,
 348                         unsigned char channel_offset, unsigned short bwmode)
 349 {
 350         u8 center_ch;
 351
 352         if (padapter->bNotifyChannelChange)
 353                 DBG_8723A("[%s] ch = %d, offset = %d, bwmode = %d\n", __func__, channel, channel_offset, bwmode);
 354
 355         if ((bwmode == HT_CHANNEL_WIDTH_20) ||
 356             (channel_offset == HAL_PRIME_CHNL_OFFSET_DONT_CARE)) {
 357                 /* SelectChannel23a(padapter, channel); */
 358                 center_ch = channel;
 359         } else {
 360                 /* switch to the proper channel */
 361                 if (channel_offset == HAL_PRIME_CHNL_OFFSET_LOWER) {
 362                         /* SelectChannel23a(padapter, channel + 2); */
 363                         center_ch = channel + 2;
 364                 } else {
 365                         /* SelectChannel23a(padapter, channel - 2); */
 366                         center_ch = channel - 2;
 367                 }
 368         }
 369
 370         /* set Channel */
 371         mutex_lock(&adapter_to_dvobj(padapter)->setch_mutex);
 372
 373         /* saved channel/bw info */
 374         rtw_set_oper_ch23a(padapter, channel);
 375         rtw_set_oper_bw23a(padapter, bwmode);
 376         rtw_set_oper_ch23aoffset23a(padapter, channel_offset);
 377
 378         rtw_hal_set_chan23a(padapter, center_ch); /*  set center channel */
 379
 380         mutex_unlock(&adapter_to_dvobj(padapter)->setch_mutex);
 381
 382         SetBWMode23a(padapter, bwmode, channel_offset);
 383 }
 384
 385 int get_bsstype23a(unsigned short capability)
 386 {
 387         if (capability & BIT(0))
 388                 return WIFI_FW_AP_STATE;
 389         else if (capability & BIT(1))
 390                 return WIFI_FW_ADHOC_STATE;
 391         return 0;
 392 }
 393
 394 inline u8 *get_my_bssid23a(struct wlan_bssid_ex *pnetwork)
 395 {
 396         return pnetwork->MacAddress;
 397 }
 398
 399 u16 get_beacon_interval23a(struct wlan_bssid_ex *bss)
 400 {
 401         unsigned short val;
 402         memcpy((unsigned char *)&val, rtw_get_beacon_interval23a_from_ie(bss->IEs), 2);
 403
 404         return le16_to_cpu(val);
 405 }
 406
 407 int is_client_associated_to_ap23a(struct rtw_adapter *padapter)
 408 {
 409         struct mlme_ext_priv    *pmlmeext;
 410         struct mlme_ext_info    *pmlmeinfo;
 411
 412         if (!padapter)
 413                 return _FAIL;
 414
 415         pmlmeext = &padapter->mlmeextpriv;
 416         pmlmeinfo = &pmlmeext->mlmext_info;
 417
 418         if ((pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) && ((pmlmeinfo->state&0x03) == WIFI_FW_STATION_STATE))
 419                 return true;
 420         else
 421                 return _FAIL;
 422 }
 423
 424 int is_client_associated_to_ibss23a(struct rtw_adapter *padapter)
 425 {
 426         struct mlme_ext_priv    *pmlmeext = &padapter->mlmeextpriv;
 427         struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
 428
 429         if ((pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) &&
 430             ((pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE))
 431                 return true;
 432         else
 433                 return _FAIL;
 434 }
 435
 436 int is_IBSS_empty23a(struct rtw_adapter *padapter)
 437 {
 438         unsigned int i;
 439         struct mlme_ext_priv    *pmlmeext = &padapter->mlmeextpriv;
 440         struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
 441
 442         for (i = IBSS_START_MAC_ID; i < NUM_STA; i++) {
 443                 if (pmlmeinfo->FW_sta_info[i].status == 1)
 444                         return _FAIL;
 445         }
 446
 447         return true;
 448 }
 449
 450 unsigned int decide_wait_for_beacon_timeout23a(unsigned int bcn_interval)
 451 {
 452         if ((bcn_interval << 2) < WAIT_FOR_BCN_TO_MIN)
 453                 return WAIT_FOR_BCN_TO_MIN;
 454         else if ((bcn_interval << 2) > WAIT_FOR_BCN_TO_MAX)
 455                 return WAIT_FOR_BCN_TO_MAX;
 456         else
 457                 return bcn_interval << 2;
 458 }
 459
 460 void invalidate_cam_all23a(struct rtw_adapter *padapter)
 461 {
 462         rtl8723a_cam_invalid_all(padapter);
 463 }
 464
 465 void clear_cam_entry23a(struct rtw_adapter *padapter, u8 entry)
 466 {
 467         unsigned char null_sta[] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00};
 468
 469         unsigned char null_key[] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00};
 470
 471         rtl8723a_cam_write(padapter, entry, 0, null_sta, null_key);
 472 }
 473
 474 int allocate_fw_sta_entry23a(struct rtw_adapter *padapter)
 475 {
 476         unsigned int mac_id;
 477         struct mlme_ext_priv    *pmlmeext = &padapter->mlmeextpriv;
 478         struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
 479
 480         for (mac_id = IBSS_START_MAC_ID; mac_id < NUM_STA; mac_id++) {
 481                 if (pmlmeinfo->FW_sta_info[mac_id].status == 0) {
 482                         pmlmeinfo->FW_sta_info[mac_id].status = 1;
 483                         pmlmeinfo->FW_sta_info[mac_id].retry = 0;
 484                         break;
 485                 }
 486         }
 487
 488         return mac_id;
 489 }
 490
 491 void flush_all_cam_entry23a(struct rtw_adapter *padapter)
 492 {
 493         struct mlme_ext_priv    *pmlmeext = &padapter->mlmeextpriv;
 494         struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
 495
 496         rtl8723a_cam_invalid_all(padapter);
 497
 498         memset((u8 *)(pmlmeinfo->FW_sta_info), 0, sizeof(pmlmeinfo->FW_sta_info));
 499 }
 500
 501 int WMM_param_handler23a(struct rtw_adapter *padapter, struct ndis_802_11_var_ies *     pIE)
 502 {
 503         /* struct registry_priv *pregpriv = &padapter->registrypriv; */
 504         struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
 505         struct mlme_ext_priv    *pmlmeext = &padapter->mlmeextpriv;
 506         struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
 507
 508         if (pmlmepriv->qospriv.qos_option == 0) {
 509                 pmlmeinfo->WMM_enable = 0;
 510                 return _FAIL;
 511         }
 512
 513         pmlmeinfo->WMM_enable = 1;
 514         memcpy(&pmlmeinfo->WMM_param, (pIE->data + 6),
 515                sizeof(struct WMM_para_element));
 516         return true;
 517 }
 518
 519 void WMMOnAssocRsp23a(struct rtw_adapter *padapter)
 520 {
 521         u8      ACI, ACM, AIFS, ECWMin, ECWMax, aSifsTime;
 522         u8      acm_mask;
 523         u16     TXOP;
 524         u32     acParm, i;
 525         u32     edca[4], inx[4];
 526         struct mlme_ext_priv    *pmlmeext = &padapter->mlmeextpriv;
 527         struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
 528         struct xmit_priv                *pxmitpriv = &padapter->xmitpriv;
 529         struct registry_priv    *pregpriv = &padapter->registrypriv;
 530
 531         if (pmlmeinfo->WMM_enable == 0) {
 532                 padapter->mlmepriv.acm_mask = 0;
 533                 return;
 534         }
 535
 536         acm_mask = 0;
 537
 538         if (pmlmeext->cur_wireless_mode == WIRELESS_11B)
 539                 aSifsTime = 10;
 540         else
 541                 aSifsTime = 16;
 542
 543                 for (i = 0; i < 4; i++) {
 544                 ACI = (pmlmeinfo->WMM_param.ac_param[i].ACI_AIFSN >> 5) & 0x03;
 545                 ACM = (pmlmeinfo->WMM_param.ac_param[i].ACI_AIFSN >> 4) & 0x01;
 546
 547                 /* AIFS = AIFSN * slot time + SIFS - r2t phy delay */
 548                 AIFS = (pmlmeinfo->WMM_param.ac_param[i].ACI_AIFSN & 0x0f) * pmlmeinfo->slotTime + aSifsTime;
 549
 550                 ECWMin = (pmlmeinfo->WMM_param.ac_param[i].CW & 0x0f);
 551                 ECWMax = (pmlmeinfo->WMM_param.ac_param[i].CW & 0xf0) >> 4;
 552                 TXOP = le16_to_cpu(pmlmeinfo->WMM_param.ac_param[i].TXOP_limit);
 553
 554                 acParm = AIFS | (ECWMin << 8) | (ECWMax << 12) | (TXOP << 16);
 555
 556                 switch (ACI) {
 557                 case 0x0:
 558                         rtl8723a_set_ac_param_be(padapter, acParm);
 559                         acm_mask |= (ACM? BIT(1):0);
 560                         edca[XMIT_BE_QUEUE] = acParm;
 561                         break;
 562                 case 0x1:
 563                         rtl8723a_set_ac_param_bk(padapter, acParm);
 564                         /* acm_mask |= (ACM? BIT(0):0); */
 565                         edca[XMIT_BK_QUEUE] = acParm;
 566                         break;
 567                 case 0x2:
 568                         rtl8723a_set_ac_param_vi(padapter, acParm);
 569                         acm_mask |= (ACM? BIT(2):0);
 570                         edca[XMIT_VI_QUEUE] = acParm;
 571                         break;
 572                 case 0x3:
 573                         rtl8723a_set_ac_param_vo(padapter, acParm);
 574                         acm_mask |= (ACM? BIT(3):0);
 575                         edca[XMIT_VO_QUEUE] = acParm;
 576                         break;
 577                 }
 578
 579                 DBG_8723A("WMM(%x): %x, %x\n", ACI, ACM, acParm);
 580         }
 581
 582         if (padapter->registrypriv.acm_method == 1)
 583                 rtl8723a_set_acm_ctrl(padapter, acm_mask);
 584         else
 585                 padapter->mlmepriv.acm_mask = acm_mask;
 586
 587         inx[0] = 0; inx[1] = 1; inx[2] = 2; inx[3] = 3;
 588
 589         if (pregpriv->wifi_spec == 1) {
 590                 u32     j, tmp, change_inx = false;
 591
 592                 /* entry indx: 0->vo, 1->vi, 2->be, 3->bk. */
 593                 for (i = 0; i < 4; i++) {
 594                         for (j = i+1; j < 4; j++) {
 595                                 /* compare CW and AIFS */
 596                                 if ((edca[j] & 0xFFFF) < (edca[i] & 0xFFFF)) {
 597                                         change_inx = true;
 598                                 } else if ((edca[j] & 0xFFFF) == (edca[i] & 0xFFFF)) {
 599                                         /* compare TXOP */
 600                                         if ((edca[j] >> 16) > (edca[i] >> 16))
 601                                                 change_inx = true;
 602                                 }
 603
 604                                 if (change_inx) {
 605                                         tmp = edca[i];
 606                                         edca[i] = edca[j];
 607                                         edca[j] = tmp;
 608
 609                                         tmp = inx[i];
 610                                         inx[i] = inx[j];
 611                                         inx[j] = tmp;
 612
 613                                         change_inx = false;
 614                                 }
 615                         }
 616                 }
 617         }
 618
 619         for (i = 0; i<4; i++) {
 620                 pxmitpriv->wmm_para_seq[i] = inx[i];
 621                 DBG_8723A("wmm_para_seq(%d): %d\n", i, pxmitpriv->wmm_para_seq[i]);
 622         }
 623
 624         return;
 625 }
 626
 627 static void bwmode_update_check(struct rtw_adapter *padapter, struct ndis_802_11_var_ies * pIE)
 628 {
 629         struct HT_info_element   *pHT_info;
 630         struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
 631         struct mlme_ext_priv    *pmlmeext = &padapter->mlmeextpriv;
 632         struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
 633         struct registry_priv *pregistrypriv = &padapter->registrypriv;
 634         struct ht_priv  *phtpriv = &pmlmepriv->htpriv;
 635         unsigned char    new_bwmode;
 636         unsigned char  new_ch_offset;
 637
 638         if (!pIE)
 639                 return;
 640         if (!phtpriv->ht_option)
 641                 return;
 642         if (pIE->Length > sizeof(struct HT_info_element))
 643                 return;
 644
 645         pHT_info = (struct HT_info_element *)pIE->data;
 646
 647         if ((pHT_info->infos[0] & BIT(2)) && pregistrypriv->cbw40_enable) {
 648                 new_bwmode = HT_CHANNEL_WIDTH_40;
 649
 650                 switch (pHT_info->infos[0] & 0x3) {
 651                 case 1:
 652                         new_ch_offset = HAL_PRIME_CHNL_OFFSET_LOWER;
 653                         break;
 654                 case 3:
 655                         new_ch_offset = HAL_PRIME_CHNL_OFFSET_UPPER;
 656                         break;
 657                 default:
 658                         new_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE;
 659                         break;
 660                 }
 661         } else {
 662                 new_bwmode = HT_CHANNEL_WIDTH_20;
 663                 new_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE;
 664         }
 665
 666         if ((new_bwmode!= pmlmeext->cur_bwmode) ||
 667             (new_ch_offset!= pmlmeext->cur_ch_offset)) {
 668                 pmlmeinfo->bwmode_updated = true;
 669
 670                 pmlmeext->cur_bwmode = new_bwmode;
 671                 pmlmeext->cur_ch_offset = new_ch_offset;
 672
 673                 /* update HT info also */
 674                 HT_info_handler23a(padapter, pIE);
 675         } else {
 676                 pmlmeinfo->bwmode_updated = false;
 677         }
 678
 679         if (pmlmeinfo->bwmode_updated) {
 680                 struct sta_info *psta;
 681                 struct wlan_bssid_ex *cur_network = &pmlmeinfo->network;
 682                 struct sta_priv *pstapriv = &padapter->stapriv;
 683
 684                 /* set_channel_bwmode23a(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); */
 685
 686                 /* update ap's stainfo */
 687                 psta = rtw_get_stainfo23a(pstapriv, cur_network->MacAddress);
 688                 if (psta) {
 689                         struct ht_priv  *phtpriv_sta = &psta->htpriv;
 690
 691                         if (phtpriv_sta->ht_option) {
 692                                 /*  bwmode */
 693                                 phtpriv_sta->bwmode = pmlmeext->cur_bwmode;
 694                                 phtpriv_sta->ch_offset = pmlmeext->cur_ch_offset;
 695                         } else {
 696                                 phtpriv_sta->bwmode = HT_CHANNEL_WIDTH_20;
 697                                 phtpriv_sta->ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE;
 698                         }
 699
 700                 }
 701         }
 702 }
 703
 704 void HT_caps_handler23a(struct rtw_adapter *padapter, struct ndis_802_11_var_ies * pIE)
 705 {
 706         unsigned int    i;
 707         u8      rf_type;
 708         u8      max_AMPDU_len, min_MPDU_spacing;
 709         struct mlme_ext_priv    *pmlmeext = &padapter->mlmeextpriv;
 710         struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
 711         struct mlme_priv                *pmlmepriv = &padapter->mlmepriv;
 712         struct ht_priv                  *phtpriv = &pmlmepriv->htpriv;
 713
 714         if (pIE == NULL) return;
 715
 716         if (phtpriv->ht_option == false)        return;
 717
 718         pmlmeinfo->HT_caps_enable = 1;
 719
 720         for (i = 0; i < (pIE->Length); i++) {
 721                 if (i != 2) {
 722                         /*      Commented by Albert 2010/07/12 */
 723                         /*      Got the endian issue here. */
 724                         pmlmeinfo->HT_caps.u.HT_cap[i] &= (pIE->data[i]);
 725                 } else {
 726                         /* modify from  fw by Thomas 2010/11/17 */
 727                         if ((pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x3) > (pIE->data[i] & 0x3))
 728                                 max_AMPDU_len = (pIE->data[i] & 0x3);
 729                         else
 730                                 max_AMPDU_len = (pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x3);
 731
 732                         if ((pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x1c) > (pIE->data[i] & 0x1c))
 733                                 min_MPDU_spacing = (pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x1c);
 734                         else
 735                                 min_MPDU_spacing = (pIE->data[i] & 0x1c);
 736
 737                         pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para = max_AMPDU_len | min_MPDU_spacing;
 738                 }
 739         }
 740
 741         /*      Commented by Albert 2010/07/12 */
 742         /*      Have to handle the endian issue after copying. */
 743         /*      HT_ext_caps didn't be used yet. */
 744         pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info = le16_to_cpu(pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info);
 745         pmlmeinfo->HT_caps.u.HT_cap_element.HT_ext_caps = le16_to_cpu(pmlmeinfo->HT_caps.u.HT_cap_element.HT_ext_caps);
 746
 747         rf_type = rtl8723a_get_rf_type(padapter);
 748
 749         /* update the MCS rates */
 750         for (i = 0; i < 16; i++) {
 751                 if ((rf_type == RF_1T1R) || (rf_type == RF_1T2R))
 752                         pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate[i] &= MCS_rate_1R23A[i];
 753                 else
 754                         pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate[i] &= MCS_rate_2R23A[i];
 755         }
 756         return;
 757 }
 758
 759 void HT_info_handler23a(struct rtw_adapter *padapter, struct ndis_802_11_var_ies * pIE)
 760 {
 761         struct mlme_ext_priv    *pmlmeext = &padapter->mlmeextpriv;
 762         struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
 763         struct mlme_priv                *pmlmepriv = &padapter->mlmepriv;
 764         struct ht_priv                  *phtpriv = &pmlmepriv->htpriv;
 765
 766         if (pIE == NULL) return;
 767
 768         if (phtpriv->ht_option == false)        return;
 769
 770         if (pIE->Length > sizeof(struct HT_info_element))
 771                 return;
 772
 773         pmlmeinfo->HT_info_enable = 1;
 774         memcpy(&pmlmeinfo->HT_info, pIE->data, pIE->Length);
 775         return;
 776 }
 777
 778 void HTOnAssocRsp23a(struct rtw_adapter *padapter)
 779 {
 780         unsigned char           max_AMPDU_len;
 781         unsigned char           min_MPDU_spacing;
 782         /* struct registry_priv  *pregpriv = &padapter->registrypriv; */
 783         struct mlme_ext_priv    *pmlmeext = &padapter->mlmeextpriv;
 784         struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
 785
 786         DBG_8723A("%s\n", __func__);
 787
 788         if ((pmlmeinfo->HT_info_enable) && (pmlmeinfo->HT_caps_enable)) {
 789                 pmlmeinfo->HT_enable = 1;
 790         } else {
 791                 pmlmeinfo->HT_enable = 0;
 792                 /* set_channel_bwmode23a(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); */
 793                 return;
 794         }
 795
 796         /* handle A-MPDU parameter field */
 797         /*
 798                 AMPDU_para [1:0]:Max AMPDU Len => 0:8k , 1:16k, 2:32k, 3:64k
 799                 AMPDU_para [4:2]:Min MPDU Start Spacing
 800         */
 801         max_AMPDU_len = pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x03;
 802
 803         min_MPDU_spacing = (pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x1c) >> 2;
 804
 805         rtl8723a_set_ampdu_min_space(padapter, min_MPDU_spacing);
 806         rtl8723a_set_ampdu_factor(padapter, max_AMPDU_len);
 807 }
 808
 809 void ERP_IE_handler23a(struct rtw_adapter *padapter, struct ndis_802_11_var_ies * pIE)
 810 {
 811         struct mlme_ext_priv    *pmlmeext = &padapter->mlmeextpriv;
 812         struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
 813
 814         if (pIE->Length>1)
 815                 return;
 816
 817         pmlmeinfo->ERP_enable = 1;
 818         memcpy(&pmlmeinfo->ERP_IE, pIE->data, pIE->Length);
 819 }
 820
 821 void VCS_update23a(struct rtw_adapter *padapter, struct sta_info *psta)
 822 {
 823         struct registry_priv     *pregpriv = &padapter->registrypriv;
 824         struct mlme_ext_priv    *pmlmeext = &padapter->mlmeextpriv;
 825         struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
 826
 827         switch (pregpriv->vrtl_carrier_sense) { /* 0:off 1:on 2:auto */
 828         case 0: /* off */
 829                 psta->rtsen = 0;
 830                 psta->cts2self = 0;
 831                 break;
 832         case 1: /* on */
 833                 if (pregpriv->vcs_type == 1) { /* 1:RTS/CTS 2:CTS to self */
 834                         psta->rtsen = 1;
 835                         psta->cts2self = 0;
 836                 } else {
 837                         psta->rtsen = 0;
 838                         psta->cts2self = 1;
 839                 }
 840                 break;
 841         case 2: /* auto */
 842         default:
 843                 if ((pmlmeinfo->ERP_enable) && (pmlmeinfo->ERP_IE & BIT(1))) {
 844                         if (pregpriv->vcs_type == 1) {
 845                                 psta->rtsen = 1;
 846                                 psta->cts2self = 0;
 847                         } else {
 848                                 psta->rtsen = 0;
 849                                 psta->cts2self = 1;
 850                         }
 851                 } else {
 852                         psta->rtsen = 0;
 853                         psta->cts2self = 0;
 854                 }
 855                 break;
 856         }
 857 }
 858
 859 int rtw_check_bcn_info23a(struct rtw_adapter *Adapter,
 860                           struct ieee80211_mgmt *mgmt, u32 pkt_len)
 861 {
 862         struct wlan_network *cur_network = &Adapter->mlmepriv.cur_network;
 863         struct HT_info_element *pht_info;
 864         struct ieee80211_ht_cap *pht_cap;
 865         struct wlan_bssid_ex *bssid;
 866         unsigned short val16;
 867         u16 wpa_len = 0, rsn_len = 0;
 868         u8 encryp_protocol;
 869         int group_cipher = 0, pairwise_cipher = 0, is_8021x = 0, r;
 870         u32 bcn_channel;
 871         unsigned short ht_cap_info;
 872         unsigned char ht_info_infos_0;
 873         int len, pie_len, ie_offset;
 874         const u8 *p;
 875         u8 *pie;
 876
 877         if (is_client_associated_to_ap23a(Adapter) == false)
 878                 return true;
 879
 880         if (unlikely(!ieee80211_is_beacon(mgmt->frame_control))) {
 881                 printk(KERN_WARNING "%s: received a non beacon frame!\n",
 882                        __func__);
 883                 return false;
 884         }
 885
 886         len = pkt_len - sizeof(struct ieee80211_hdr_3addr);
 887
 888         if (len > MAX_IE_SZ) {
 889                 DBG_8723A("%s IE too long for survey event\n", __func__);
 890                 return _FAIL;
 891         }
 892
 893         if (memcmp(cur_network->network.MacAddress, mgmt->bssid, 6)) {
 894                 DBG_8723A("Oops: rtw_check_network_encrypt linked but recv "
 895                           "other bssid bcn\n" MAC_FMT MAC_FMT,
 896                           MAC_ARG(mgmt->bssid),
 897                           MAC_ARG(cur_network->network.MacAddress));
 898                 return true;
 899         }
 900
 901         bssid = (struct wlan_bssid_ex *)kzalloc(sizeof(struct wlan_bssid_ex),
 902                 GFP_ATOMIC);
 903
 904         bssid->reserved = 1;
 905
 906         bssid->Length = sizeof(struct wlan_bssid_ex) - MAX_IE_SZ + len;
 907
 908         /* below is to copy the information element */
 909         bssid->IELength = len;
 910         memcpy(bssid->IEs, &mgmt->u, bssid->IELength);
 911
 912         /* check bw and channel offset */
 913         /* parsing HT_CAP_IE */
 914         ie_offset = offsetof(struct ieee80211_mgmt, u.beacon.variable) -
 915                 offsetof(struct ieee80211_mgmt, u);
 916         pie = bssid->IEs + ie_offset;
 917         pie_len = pkt_len - ie_offset;
 918
 919         p = cfg80211_find_ie(WLAN_EID_HT_CAPABILITY, pie, pie_len);
 920         if (p && p[1] > 0) {
 921                 pht_cap = (struct ieee80211_ht_cap *)(p + 2);
 922                 ht_cap_info = pht_cap->cap_info;
 923         } else {
 924                 pht_cap = NULL;
 925                 ht_cap_info = 0;
 926         }
 927
 928         /* parsing HT_INFO_IE */
 929         p = cfg80211_find_ie(WLAN_EID_HT_OPERATION, pie, pie_len);
 930         if (p && p[1] > 0) {
 931                 pht_info = (struct HT_info_element *)(p + 2);
 932                 ht_info_infos_0 = pht_info->infos[0];
 933         } else {
 934                 pht_info = NULL;
 935                 ht_info_infos_0 = 0;
 936         }
 937
 938         if (ht_cap_info != cur_network->BcnInfo.ht_cap_info ||
 939             ((ht_info_infos_0 & 0x03) !=
 940              (cur_network->BcnInfo.ht_info_infos_0 & 0x03))) {
 941                 DBG_8723A("%s bcn now: ht_cap_info:%x ht_info_infos_0:%x\n",
 942                           __func__, ht_cap_info, ht_info_infos_0);
 943                 DBG_8723A("%s bcn link: ht_cap_info:%x ht_info_infos_0:%x\n",
 944                           __func__, cur_network->BcnInfo.ht_cap_info,
 945                           cur_network->BcnInfo.ht_info_infos_0);
 946                 DBG_8723A("%s bw mode change, disconnect\n", __func__);
 947                 /* bcn_info_update */
 948                 cur_network->BcnInfo.ht_cap_info = ht_cap_info;
 949                 cur_network->BcnInfo.ht_info_infos_0 = ht_info_infos_0;
 950                 /* to do : need to check that whether modify related
 951                    register of BB or not */
 952         }
 953
 954         /* Checking for channel */
 955         p = cfg80211_find_ie(WLAN_EID_DS_PARAMS, pie, pie_len);
 956         if (p)
 957                 bcn_channel = p[2];
 958         else {
 959                 /* In 5G, some ap do not have DSSET IE checking HT
 960                    info for channel */
 961                 p = cfg80211_find_ie(WLAN_EID_HT_OPERATION, pie, pie_len);
 962
 963                 if (pht_info)
 964                         bcn_channel = pht_info->primary_channel;
 965                 else { /* we don't find channel IE, so don't check it */
 966                         DBG_8723A("Oops: %s we don't find channel IE, so don't "
 967                                   "check it\n", __func__);
 968                         bcn_channel = Adapter->mlmeextpriv.cur_channel;
 969                 }
 970         }
 971         if (bcn_channel != Adapter->mlmeextpriv.cur_channel) {
 972                 DBG_8723A("%s beacon channel:%d cur channel:%d disconnect\n",
 973                           __func__, bcn_channel,
 974                           Adapter->mlmeextpriv.cur_channel);
 975                 goto _mismatch;
 976         }
 977
 978         /* checking SSID */
 979         p = cfg80211_find_ie(WLAN_EID_SSID, pie, pie_len);
 980         if (p && p[1]) {
 981                 memcpy(bssid->Ssid.ssid, p + 2, p[1]);
 982                 bssid->Ssid.ssid_len = p[1];
 983         } else {
 984                 DBG_8723A("%s marc: cannot find SSID for survey event\n",
 985                           __func__);
 986                 bssid->Ssid.ssid_len = 0;
 987                 bssid->Ssid.ssid[0] = '\0';
 988         }
 989
 990         RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_,
 991                  ("%s bssid.Ssid.Ssid:%s bssid.Ssid.SsidLength:%d "
 992                   "cur_network->network.Ssid.Ssid:%s len:%d\n", __func__,
 993                   bssid->Ssid.ssid, bssid->Ssid.ssid_len,
 994                   cur_network->network.Ssid.ssid,
 995                   cur_network->network.Ssid.ssid_len));
 996
 997         if (memcmp(bssid->Ssid.ssid, cur_network->network.Ssid.ssid, 32) ||
 998             bssid->Ssid.ssid_len != cur_network->network.Ssid.ssid_len) {
 999                 if (bssid->Ssid.ssid[0] != '\0' &&
1000                     bssid->Ssid.ssid_len != 0) { /* not hidden ssid */
1001                         DBG_8723A("%s(), SSID is not match return FAIL\n",
1002                                   __func__);
1003                         goto _mismatch;
1004                 }
1005         }
1006
1007         /* check encryption info */
1008         val16 = rtw_get_capability23a((struct wlan_bssid_ex *)bssid);
1009
1010         if (val16 & BIT(4))
1011                 bssid->Privacy = 1;
1012         else
1013                 bssid->Privacy = 0;
1014
1015         RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_,
1016                  ("%s(): cur_network->network.Privacy is %d, bssid.Privacy "
1017                   "is %d\n", __func__, cur_network->network.Privacy,
1018                   bssid->Privacy));
1019         if (cur_network->network.Privacy != bssid->Privacy) {
1020                 DBG_8723A("%s(), privacy is not match return FAIL\n", __func__);
1021                 goto _mismatch;
1022         }
1023
1024         rtw_get_sec_ie23a(bssid->IEs, bssid->IELength, NULL, &rsn_len, NULL,
1025                           &wpa_len);
1026
1027         if (rsn_len > 0)
1028                 encryp_protocol = ENCRYP_PROTOCOL_WPA2;
1029         else if (wpa_len > 0)
1030                 encryp_protocol = ENCRYP_PROTOCOL_WPA;
1031         else {
1032                 if (bssid->Privacy)
1033                         encryp_protocol = ENCRYP_PROTOCOL_WEP;
1034                 else
1035                         encryp_protocol = ENCRYP_PROTOCOL_OPENSYS;
1036         }
1037
1038         if (cur_network->BcnInfo.encryp_protocol != encryp_protocol) {
1039                 DBG_8723A("%s(): enctyp is not match, return FAIL\n", __func__);
1040                 goto _mismatch;
1041         }
1042
1043         if (encryp_protocol == ENCRYP_PROTOCOL_WPA ||
1044             encryp_protocol == ENCRYP_PROTOCOL_WPA2) {
1045                 p = cfg80211_find_vendor_ie(WLAN_OUI_MICROSOFT,
1046                                             WLAN_OUI_TYPE_MICROSOFT_WPA,
1047                                             pie, pie_len);
1048                 if (p && p[1] > 0) {
1049                         r = rtw_parse_wpa_ie23a(p, p[1] + 2, &group_cipher,
1050                                                 &pairwise_cipher, &is_8021x);
1051                         if (r == _SUCCESS)
1052                                 RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_,
1053                                          ("%s pnetwork->pairwise_cipher: %d, "
1054                                           "group_cipher is %d, is_8021x is "
1055                                           "%d\n", __func__, pairwise_cipher,
1056                                           group_cipher, is_8021x));
1057                 } else {
1058                         p = cfg80211_find_ie(WLAN_EID_RSN, pie, pie_len);
1059
1060                         if (p && p[1] > 0) {
1061                                 r = rtw_parse_wpa2_ie23a(p, p[1] + 2,
1062                                                          &group_cipher,
1063                                                          &pairwise_cipher,
1064                                                          &is_8021x);
1065                                 if (r == _SUCCESS)
1066                                         RT_TRACE(_module_rtl871x_mlme_c_,
1067                                                  _drv_info_,
1068                                                  ("%s pnetwork->pairwise_cipher"
1069                                                   ": %d, pnetwork->group_cipher"
1070                                                   " is %d, is_802x is %d\n",
1071                                                   __func__, pairwise_cipher,
1072                                                   group_cipher, is_8021x));
1073                         }
1074                 }
1075
1076                 RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_,
1077                          ("%s cur_network->group_cipher is %d: %d\n", __func__,
1078                           cur_network->BcnInfo.group_cipher, group_cipher));
1079                 if (pairwise_cipher != cur_network->BcnInfo.pairwise_cipher ||
1080                     group_cipher != cur_network->BcnInfo.group_cipher) {
1081                         DBG_8723A("%s pairwise_cipher(%x:%x) or group_cipher "
1082                                   "(%x:%x) is not match, return FAIL\n",
1083                                   __func__, pairwise_cipher,
1084                                   cur_network->BcnInfo.pairwise_cipher,
1085                                   group_cipher,
1086                                   cur_network->BcnInfo.group_cipher);
1087                         goto _mismatch;
1088                 }
1089
1090                 if (is_8021x != cur_network->BcnInfo.is_8021x) {
1091                         DBG_8723A("%s authentication is not match, return "
1092                                   "FAIL\n", __func__);
1093                         goto _mismatch;
1094                 }
1095         }
1096
1097         kfree(bssid);
1098         return _SUCCESS;
1099
1100 _mismatch:
1101         kfree(bssid);
1102
1103         return _FAIL;
1104 }
1105
1106 void update_beacon23a_info(struct rtw_adapter *padapter, u8 *pframe, uint pkt_len, struct sta_info *psta)
1107 {
1108         unsigned int i;
1109         unsigned int len;
1110         struct ndis_802_11_var_ies *    pIE;
1111
1112         len = pkt_len -
1113                 (_BEACON_IE_OFFSET_ + sizeof(struct ieee80211_hdr_3addr));
1114
1115         for (i = 0; i < len;) {
1116                 pIE = (struct ndis_802_11_var_ies *)(pframe + (_BEACON_IE_OFFSET_ + sizeof(struct ieee80211_hdr_3addr)) + i);
1117
1118                 switch (pIE->ElementID) {
1119                 case WLAN_EID_HT_OPERATION:     /* HT info */
1120                         /* HT_info_handler23a(padapter, pIE); */
1121                         bwmode_update_check(padapter, pIE);
1122                         break;
1123                 case WLAN_EID_ERP_INFO:
1124                         ERP_IE_handler23a(padapter, pIE);
1125                         VCS_update23a(padapter, psta);
1126                         break;
1127                 default:
1128                         break;
1129                 }
1130                 i += (pIE->Length + 2);
1131         }
1132 }
1133
1134 unsigned int is_ap_in_tkip23a(struct rtw_adapter *padapter)
1135 {
1136         u32 i;
1137         struct ndis_802_11_var_ies *    pIE;
1138         struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
1139         struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
1140         struct wlan_bssid_ex *cur_network = &pmlmeinfo->network;
1141
1142         if (rtw_get_capability23a((struct wlan_bssid_ex *)cur_network) & WLAN_CAPABILITY_PRIVACY) {
1143                 for (i = sizeof(struct ndis_802_11_fixed_ies); i < pmlmeinfo->network.IELength;) {
1144                         pIE = (struct ndis_802_11_var_ies *)(pmlmeinfo->network.IEs + i);
1145
1146                         switch (pIE->ElementID) {
1147                         case WLAN_EID_VENDOR_SPECIFIC:
1148                                 if ((!memcmp(pIE->data, RTW_WPA_OUI23A_TYPE, 4)) && (!memcmp((pIE->data + 12), WPA_TKIP_CIPHER23A, 4)))
1149                                         return true;
1150                                 break;
1151                         case WLAN_EID_RSN:
1152                                 if (!memcmp((pIE->data + 8), RSN_TKIP_CIPHER23A, 4))
1153                                         return true;
1154                                 break;
1155                         default:
1156                                 break;
1157                         }
1158                         i += (pIE->Length + 2);
1159                 }
1160                 return false;
1161         } else {
1162                 return false;
1163         }
1164 }
1165
1166 unsigned int should_forbid_n_rate23a(struct rtw_adapter * padapter)
1167 {
1168         u32 i;
1169         struct ndis_802_11_var_ies *    pIE;
1170         struct mlme_priv        *pmlmepriv = &padapter->mlmepriv;
1171         struct wlan_bssid_ex  *cur_network = &pmlmepriv->cur_network.network;
1172
1173         if (rtw_get_capability23a((struct wlan_bssid_ex *)cur_network) & WLAN_CAPABILITY_PRIVACY) {
1174                 for (i = sizeof(struct ndis_802_11_fixed_ies); i < cur_network->IELength;) {
1175                         pIE = (struct ndis_802_11_var_ies *)(cur_network->IEs + i);
1176
1177                         switch (pIE->ElementID) {
1178                         case WLAN_EID_VENDOR_SPECIFIC:
1179                                 if (!memcmp(pIE->data, RTW_WPA_OUI23A_TYPE, 4) &&
1180                                         ((!memcmp((pIE->data + 12), WPA_CIPHER_SUITE_CCMP23A, 4)) ||
1181                                           (!memcmp((pIE->data + 16), WPA_CIPHER_SUITE_CCMP23A, 4))))
1182                                         return false;
1183                                 break;
1184                         case WLAN_EID_RSN:
1185                                 if  ((!memcmp((pIE->data + 8), RSN_CIPHER_SUITE_CCMP23A, 4))  ||
1186                                        (!memcmp((pIE->data + 12), RSN_CIPHER_SUITE_CCMP23A, 4)))
1187                                 return false;
1188                         default:
1189                                 break;
1190                         }
1191
1192                         i += (pIE->Length + 2);
1193                 }
1194                 return true;
1195         } else {
1196                 return false;
1197         }
1198 }
1199
1200 unsigned int is_ap_in_wep23a(struct rtw_adapter *padapter)
1201 {
1202         u32 i;
1203         struct ndis_802_11_var_ies *    pIE;
1204         struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
1205         struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
1206         struct wlan_bssid_ex *cur_network = &pmlmeinfo->network;
1207
1208         if (rtw_get_capability23a((struct wlan_bssid_ex *)cur_network) & WLAN_CAPABILITY_PRIVACY) {
1209                 for (i = sizeof(struct ndis_802_11_fixed_ies); i < pmlmeinfo->network.IELength;) {
1210                         pIE = (struct ndis_802_11_var_ies *)(pmlmeinfo->network.IEs + i);
1211
1212                         switch (pIE->ElementID) {
1213                         case WLAN_EID_VENDOR_SPECIFIC:
1214                                 if (!memcmp(pIE->data, RTW_WPA_OUI23A_TYPE, 4))
1215                                         return false;
1216                                 break;
1217                         case WLAN_EID_RSN:
1218                                 return false;
1219
1220                         default:
1221                                 break;
1222                         }
1223
1224                         i += (pIE->Length + 2);
1225                 }
1226
1227                 return true;
1228         } else {
1229                 return false;
1230         }
1231 }
1232
1233 int wifirate2_ratetbl_inx23a(unsigned char rate)
1234 {
1235         int     inx = 0;
1236         rate = rate & 0x7f;
1237
1238         switch (rate) {
1239         case 54*2:
1240                 inx = 11;
1241                 break;
1242         case 48*2:
1243                 inx = 10;
1244                 break;
1245         case 36*2:
1246                 inx = 9;
1247                 break;
1248         case 24*2:
1249                 inx = 8;
1250                 break;
1251         case 18*2:
1252                 inx = 7;
1253                 break;
1254         case 12*2:
1255                 inx = 6;
1256                 break;
1257         case 9*2:
1258                 inx = 5;
1259                 break;
1260         case 6*2:
1261                 inx = 4;
1262                 break;
1263         case 11*2:
1264                 inx = 3;
1265                 break;
1266         case 11:
1267                 inx = 2;
1268                 break;
1269         case 2*2:
1270                 inx = 1;
1271                 break;
1272         case 1*2:
1273                 inx = 0;
1274                 break;
1275         }
1276         return inx;
1277 }
1278
1279 unsigned int update_basic_rate23a(unsigned char *ptn, unsigned int ptn_sz)
1280 {
1281         unsigned int i, num_of_rate;
1282         unsigned int mask = 0;
1283
1284         num_of_rate = (ptn_sz > NumRates)? NumRates: ptn_sz;
1285
1286         for (i = 0; i < num_of_rate; i++) {
1287                 if ((*(ptn + i)) & 0x80)
1288                         mask |= 0x1 << wifirate2_ratetbl_inx23a(*(ptn + i));
1289         }
1290         return mask;
1291 }
1292
1293 unsigned int update_supported_rate23a(unsigned char *ptn, unsigned int ptn_sz)
1294 {
1295         unsigned int i, num_of_rate;
1296         unsigned int mask = 0;
1297
1298         num_of_rate = (ptn_sz > NumRates)? NumRates: ptn_sz;
1299
1300         for (i = 0; i < num_of_rate; i++)
1301                 mask |= 0x1 << wifirate2_ratetbl_inx23a(*(ptn + i));
1302         return mask;
1303 }
1304
1305 unsigned int update_MSC_rate23a(struct HT_caps_element *pHT_caps)
1306 {
1307         unsigned int mask = 0;
1308
1309         mask = ((pHT_caps->u.HT_cap_element.MCS_rate[0] << 12) | (pHT_caps->u.HT_cap_element.MCS_rate[1] << 20));
1310
1311         return mask;
1312 }
1313
1314 int support_short_GI23a(struct rtw_adapter *padapter,
1315                      struct HT_caps_element *pHT_caps)
1316 {
1317         struct mlme_ext_priv    *pmlmeext = &padapter->mlmeextpriv;
1318         struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
1319         unsigned char bit_offset;
1320
1321         if (!(pmlmeinfo->HT_enable))
1322                 return _FAIL;
1323         if ((pmlmeinfo->assoc_AP_vendor == HT_IOT_PEER_RALINK))
1324                 return _FAIL;
1325         bit_offset = (pmlmeext->cur_bwmode & HT_CHANNEL_WIDTH_40)? 6: 5;
1326
1327         if (pHT_caps->u.HT_cap_element.HT_caps_info & (0x1 << bit_offset))
1328                 return _SUCCESS;
1329         else
1330                 return _FAIL;
1331 }
1332
1333 unsigned char get_highest_rate_idx23a(u32 mask)
1334 {
1335         int i;
1336         unsigned char rate_idx = 0;
1337
1338         for (i = 27; i >= 0; i--) {
1339                 if (mask & BIT(i)) {
1340                         rate_idx = i;
1341                         break;
1342                 }
1343         }
1344         return rate_idx;
1345 }
1346
1347 unsigned char get_highest_mcs_rate(struct HT_caps_element *pHT_caps)
1348 {
1349         int i, mcs_rate;
1350
1351         mcs_rate = (pHT_caps->u.HT_cap_element.MCS_rate[0] | (pHT_caps->u.HT_cap_element.MCS_rate[1] << 8));
1352
1353         for (i = 15; i >= 0; i--) {
1354                 if (mcs_rate & (0x1 << i))
1355                         break;
1356         }
1357         return i;
1358 }
1359
1360 void Update_RA_Entry23a(struct rtw_adapter *padapter, struct sta_info *psta)
1361 {
1362         rtw_hal_update_ra_mask23a(psta, 0);
1363 }
1364
1365 void enable_rate_adaptive(struct rtw_adapter *padapter, struct sta_info *psta)
1366 {
1367         Update_RA_Entry23a(padapter, psta);
1368 }
1369
1370 void set_sta_rate23a(struct rtw_adapter *padapter, struct sta_info *psta)
1371 {
1372         /* rate adaptive */
1373         enable_rate_adaptive(padapter, psta);
1374 }
1375
1376 /*  Update RRSR and Rate for USERATE */
1377 void update_tx_basic_rate23a(struct rtw_adapter *padapter, u8 wirelessmode)
1378 {
1379         unsigned char supported_rates[NDIS_802_11_LENGTH_RATES_EX];
1380
1381         memset(supported_rates, 0, NDIS_802_11_LENGTH_RATES_EX);
1382
1383         if ((wirelessmode & WIRELESS_11B) && (wirelessmode == WIRELESS_11B)) {
1384                 memcpy(supported_rates, rtw_basic_rate_cck, 4);
1385         } else if (wirelessmode & WIRELESS_11B) {
1386                 memcpy(supported_rates, rtw_basic_rate_mix, 7);
1387         } else {
1388                 memcpy(supported_rates, rtw_basic_rate_ofdm, 3);
1389         }
1390
1391         if (wirelessmode & WIRELESS_11B)
1392                 update_mgnt_tx_rate23a(padapter, IEEE80211_CCK_RATE_1MB);
1393         else
1394                 update_mgnt_tx_rate23a(padapter, IEEE80211_OFDM_RATE_6MB);
1395
1396         HalSetBrateCfg23a(padapter, supported_rates);
1397 }
1398
1399 unsigned char check_assoc_AP23a(u8 *pframe, uint len)
1400 {
1401         unsigned int    i;
1402         struct ndis_802_11_var_ies *    pIE;
1403         u8      epigram_vendor_flag;
1404         u8      ralink_vendor_flag;
1405         epigram_vendor_flag = 0;
1406         ralink_vendor_flag = 0;
1407
1408         for (i = sizeof(struct ndis_802_11_fixed_ies); i < len;) {
1409                 pIE = (struct ndis_802_11_var_ies *)(pframe + i);
1410
1411                 switch (pIE->ElementID) {
1412                 case WLAN_EID_VENDOR_SPECIFIC:
1413                         if ((!memcmp(pIE->data, ARTHEROS_OUI1, 3)) ||
1414                             (!memcmp(pIE->data, ARTHEROS_OUI2, 3))) {
1415                                 DBG_8723A("link to Artheros AP\n");
1416                                 return HT_IOT_PEER_ATHEROS;
1417                         } else if ((!memcmp(pIE->data, BROADCOM_OUI1, 3)) ||
1418                                    !memcmp(pIE->data, BROADCOM_OUI2, 3) ||
1419                                    !memcmp(pIE->data, BROADCOM_OUI2, 3)) {
1420                                 DBG_8723A("link to Broadcom AP\n");
1421                                 return HT_IOT_PEER_BROADCOM;
1422                         } else if (!memcmp(pIE->data, MARVELL_OUI, 3)) {
1423                                 DBG_8723A("link to Marvell AP\n");
1424                                 return HT_IOT_PEER_MARVELL;
1425                         } else if (!memcmp(pIE->data, RALINK_OUI, 3)) {
1426                                 if (!ralink_vendor_flag) {
1427                                         ralink_vendor_flag = 1;
1428                                 } else {
1429                                         DBG_8723A("link to Ralink AP\n");
1430                                         return HT_IOT_PEER_RALINK;
1431                                 }
1432                         } else if (!memcmp(pIE->data, CISCO_OUI, 3)) {
1433                                 DBG_8723A("link to Cisco AP\n");
1434                                 return HT_IOT_PEER_CISCO;
1435                         } else if (!memcmp(pIE->data, REALTEK_OUI, 3)) {
1436                                 DBG_8723A("link to Realtek 96B\n");
1437                                 return HT_IOT_PEER_REALTEK;
1438                         } else if (!memcmp(pIE->data, AIRGOCAP_OUI, 3)) {
1439                                 DBG_8723A("link to Airgo Cap\n");
1440                                 return HT_IOT_PEER_AIRGO;
1441                         } else if (!memcmp(pIE->data, EPIGRAM_OUI, 3)) {
1442                                 epigram_vendor_flag = 1;
1443                                 if (ralink_vendor_flag) {
1444                                         DBG_8723A("link to Tenda W311R AP\n");
1445                                         return HT_IOT_PEER_TENDA;
1446                                 } else {
1447                                         DBG_8723A("Capture EPIGRAM_OUI\n");
1448                                 }
1449                         } else {
1450                                 break;
1451                         }
1452                 default:
1453                         break;
1454                 }
1455
1456                 i += (pIE->Length + 2);
1457         }
1458
1459         if (ralink_vendor_flag && !epigram_vendor_flag) {
1460                 DBG_8723A("link to Ralink AP\n");
1461                 return HT_IOT_PEER_RALINK;
1462         } else if (ralink_vendor_flag && epigram_vendor_flag) {
1463                 DBG_8723A("link to Tenda W311R AP\n");
1464                 return HT_IOT_PEER_TENDA;
1465         } else {
1466                 DBG_8723A("link to new AP\n");
1467                 return HT_IOT_PEER_UNKNOWN;
1468         }
1469 }
1470
1471 void update_IOT_info23a(struct rtw_adapter *padapter)
1472 {
1473         struct mlme_ext_priv    *pmlmeext = &padapter->mlmeextpriv;
1474         struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
1475
1476         switch (pmlmeinfo->assoc_AP_vendor) {
1477         case HT_IOT_PEER_MARVELL:
1478                 pmlmeinfo->turboMode_cts2self = 1;
1479                 pmlmeinfo->turboMode_rtsen = 0;
1480                 break;
1481         case HT_IOT_PEER_RALINK:
1482                 pmlmeinfo->turboMode_cts2self = 0;
1483                 pmlmeinfo->turboMode_rtsen = 1;
1484                 /* disable high power */
1485                 rtl8723a_odm_support_ability_clr(padapter, (u32)
1486                                                  ~DYNAMIC_BB_DYNAMIC_TXPWR);
1487                 break;
1488         case HT_IOT_PEER_REALTEK:
1489                 /* rtw_write16(padapter, 0x4cc, 0xffff); */
1490                 /* rtw_write16(padapter, 0x546, 0x01c0); */
1491                 /* disable high power */
1492                 rtl8723a_odm_support_ability_clr(padapter, (u32)
1493                                                  ~DYNAMIC_BB_DYNAMIC_TXPWR);
1494                 break;
1495         default:
1496                 pmlmeinfo->turboMode_cts2self = 0;
1497                 pmlmeinfo->turboMode_rtsen = 1;
1498                 break;
1499         }
1500 }
1501
1502 void update_capinfo23a(struct rtw_adapter *Adapter, u16 updateCap)
1503 {
1504         struct mlme_ext_priv    *pmlmeext = &Adapter->mlmeextpriv;
1505         struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
1506
1507         if (updateCap & cShortPreamble) {
1508                 /*  Short Preamble */
1509                 if (pmlmeinfo->preamble_mode != PREAMBLE_SHORT) {
1510                         /*  PREAMBLE_LONG or PREAMBLE_AUTO */
1511                         pmlmeinfo->preamble_mode = PREAMBLE_SHORT;
1512                         rtl8723a_ack_preamble(Adapter, true);
1513                 }
1514         } else { /*  Long Preamble */
1515                 if (pmlmeinfo->preamble_mode != PREAMBLE_LONG) {
1516                         /*  PREAMBLE_SHORT or PREAMBLE_AUTO */
1517                         pmlmeinfo->preamble_mode = PREAMBLE_LONG;
1518                         rtl8723a_ack_preamble(Adapter, false);
1519                 }
1520         }
1521         if (updateCap & cIBSS) {
1522                 /* Filen: See 802.11-2007 p.91 */
1523                 pmlmeinfo->slotTime = NON_SHORT_SLOT_TIME;
1524         } else {
1525                 /* Filen: See 802.11-2007 p.90 */
1526                 if (pmlmeext->cur_wireless_mode & (WIRELESS_11G | WIRELESS_11_24N)) {
1527                         if (updateCap & cShortSlotTime) { /*  Short Slot Time */
1528                                 if (pmlmeinfo->slotTime != SHORT_SLOT_TIME)
1529                                         pmlmeinfo->slotTime = SHORT_SLOT_TIME;
1530                         } else { /*  Long Slot Time */
1531                                 if (pmlmeinfo->slotTime != NON_SHORT_SLOT_TIME)
1532                                         pmlmeinfo->slotTime = NON_SHORT_SLOT_TIME;
1533                         }
1534                 } else if (pmlmeext->cur_wireless_mode & (WIRELESS_11A | WIRELESS_11_5N)) {
1535                         pmlmeinfo->slotTime = SHORT_SLOT_TIME;
1536                 } else {
1537                         /* B Mode */
1538                         pmlmeinfo->slotTime = NON_SHORT_SLOT_TIME;
1539                 }
1540         }
1541         rtl8723a_set_slot_time(Adapter, pmlmeinfo->slotTime);
1542 }
1543
1544 void update_wireless_mode23a(struct rtw_adapter *padapter)
1545 {
1546         int ratelen, network_type = 0;
1547         struct mlme_ext_priv    *pmlmeext = &padapter->mlmeextpriv;
1548         struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
1549         struct wlan_bssid_ex *cur_network = &pmlmeinfo->network;
1550         unsigned char                   *rate = cur_network->SupportedRates;
1551
1552         ratelen = rtw_get_rateset_len23a(cur_network->SupportedRates);
1553
1554         if ((pmlmeinfo->HT_info_enable) && (pmlmeinfo->HT_caps_enable))
1555                 pmlmeinfo->HT_enable = 1;
1556
1557         if (pmlmeext->cur_channel > 14) {
1558                 if (pmlmeinfo->HT_enable)
1559                         network_type = WIRELESS_11_5N;
1560                 network_type |= WIRELESS_11A;
1561         } else {
1562                 if (pmlmeinfo->HT_enable)
1563                         network_type = WIRELESS_11_24N;
1564
1565                 if ((cckratesonly_included23a(rate, ratelen)) == true)
1566                         network_type |= WIRELESS_11B;
1567                 else if ((cckrates_included23a(rate, ratelen)) == true)
1568                         network_type |= WIRELESS_11BG;
1569                 else
1570                         network_type |= WIRELESS_11G;
1571         }
1572
1573         pmlmeext->cur_wireless_mode = network_type & padapter->registrypriv.wireless_mode;
1574
1575         /* 0x0808 -> for CCK, 0x0a0a -> for OFDM */
1576         /* change this value if having IOT issues. */
1577         rtl8723a_set_resp_sifs(padapter, 0x08, 0x08, 0x0a, 0x0a);
1578
1579         if (pmlmeext->cur_wireless_mode & WIRELESS_11B)
1580                 update_mgnt_tx_rate23a(padapter, IEEE80211_CCK_RATE_1MB);
1581          else
1582                 update_mgnt_tx_rate23a(padapter, IEEE80211_OFDM_RATE_6MB);
1583 }
1584
1585 void update_bmc_sta_support_rate23a(struct rtw_adapter *padapter, u32 mac_id)
1586 {
1587         struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
1588         struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
1589
1590         if (pmlmeext->cur_wireless_mode & WIRELESS_11B) {
1591                 /*  Only B, B/G, and B/G/N AP could use CCK rate */
1592                 memcpy((pmlmeinfo->FW_sta_info[mac_id].SupportedRates), rtw_basic_rate_cck, 4);
1593         } else {
1594                 memcpy((pmlmeinfo->FW_sta_info[mac_id].SupportedRates), rtw_basic_rate_ofdm, 4);
1595         }
1596 }
1597
1598 int update_sta_support_rate23a(struct rtw_adapter *padapter, u8 *pvar_ie,
1599                                uint var_ie_len, int cam_idx)
1600 {
1601         int supportRateNum = 0;
1602         struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
1603         struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
1604         const u8 *p;
1605
1606         p = cfg80211_find_ie(WLAN_EID_SUPP_RATES, pvar_ie, var_ie_len);
1607         if (!p)
1608                 return _FAIL;
1609
1610         memcpy(pmlmeinfo->FW_sta_info[cam_idx].SupportedRates, p + 2, p[1]);
1611         supportRateNum = p[1];
1612
1613         p = cfg80211_find_ie(WLAN_EID_EXT_SUPP_RATES, pvar_ie, var_ie_len);
1614         if (p)
1615                 memcpy(pmlmeinfo->FW_sta_info[cam_idx].SupportedRates +
1616                        supportRateNum, p + 2, p[1]);
1617         return _SUCCESS;
1618 }
1619
1620 void process_addba_req23a(struct rtw_adapter *padapter, u8 *paddba_req, u8 *addr)
1621 {
1622         struct sta_info *psta;
1623         u16 tid, start_seq, param;
1624         struct recv_reorder_ctrl *preorder_ctrl;
1625         struct sta_priv *pstapriv = &padapter->stapriv;
1626         struct ADDBA_request    *preq = (struct ADDBA_request*)paddba_req;
1627         struct mlme_ext_priv    *pmlmeext = &padapter->mlmeextpriv;
1628         struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
1629
1630         psta = rtw_get_stainfo23a(pstapriv, addr);
1631
1632         if (psta) {
1633                 start_seq = le16_to_cpu(preq->BA_starting_seqctrl) >> 4;
1634
1635                 param = le16_to_cpu(preq->BA_para_set);
1636                 tid = (param>>2)&0x0f;
1637
1638                 preorder_ctrl = &psta->recvreorder_ctrl[tid];
1639
1640                 preorder_ctrl->indicate_seq = 0xffff;
1641
1642                 preorder_ctrl->enable = (pmlmeinfo->bAcceptAddbaReq == true)? true :false;
1643         }
1644 }
1645
1646 void beacon_timing_control23a(struct rtw_adapter *padapter)
1647 {
1648         rtw_hal_bcn_related_reg_setting23a(padapter);
1649 }
1650
1651 static struct rtw_adapter *pbuddy_padapter;
1652
1653 int rtw_handle_dualmac23a(struct rtw_adapter *adapter, bool init)
1654 {
1655         int status = _SUCCESS;
1656
1657         if (init) {
1658                 if (pbuddy_padapter == NULL) {
1659                         pbuddy_padapter = adapter;
1660                         DBG_8723A("%s(): pbuddy_padapter == NULL, Set pbuddy_padapter\n", __func__);
1661                 } else {
1662                         adapter->pbuddy_adapter = pbuddy_padapter;
1663                         pbuddy_padapter->pbuddy_adapter = adapter;
1664                         /*  clear global value */
1665                         pbuddy_padapter = NULL;
1666                         DBG_8723A("%s(): pbuddy_padapter exist, Exchange Information\n", __func__);
1667                 }
1668           } else {
1669                 pbuddy_padapter = NULL;
1670         }
1671         return status;
1672 }