Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 1 | /****************************************************************************** |
| 2 | * |
| 3 | * Copyright(c) 2007 - 2011 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 | * |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 14 | ******************************************************************************/ |
| 15 | #define _RTL8188E_CMD_C_ |
| 16 | |
| 17 | #include <osdep_service.h> |
| 18 | #include <drv_types.h> |
| 19 | #include <recv_osdep.h> |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 20 | #include <mlme_osdep.h> |
| 21 | #include <rtw_ioctl_set.h> |
| 22 | |
| 23 | #include <rtl8188e_hal.h> |
| 24 | |
| 25 | #define RTL88E_MAX_H2C_BOX_NUMS 4 |
| 26 | #define RTL88E_MAX_CMD_LEN 7 |
| 27 | #define RTL88E_MESSAGE_BOX_SIZE 4 |
| 28 | #define RTL88E_EX_MESSAGE_BOX_SIZE 4 |
| 29 | |
| 30 | static u8 _is_fw_read_cmd_down(struct adapter *adapt, u8 msgbox_num) |
| 31 | { |
| 32 | u8 read_down = false; |
| 33 | int retry_cnts = 100; |
| 34 | |
| 35 | u8 valid; |
| 36 | |
| 37 | do { |
navin patidar | c7b2e99 | 2014-06-11 22:51:36 +0530 | [diff] [blame] | 38 | valid = usb_read8(adapt, REG_HMETFR) & BIT(msgbox_num); |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 39 | if (0 == valid) |
| 40 | read_down = true; |
| 41 | } while ((!read_down) && (retry_cnts--)); |
| 42 | |
| 43 | return read_down; |
| 44 | } |
| 45 | |
| 46 | /***************************************** |
| 47 | * H2C Msg format : |
| 48 | * 0x1DF - 0x1D0 |
| 49 | *| 31 - 8 | 7-5 4 - 0 | |
| 50 | *| h2c_msg |Class_ID CMD_ID | |
| 51 | * |
| 52 | * Extend 0x1FF - 0x1F0 |
| 53 | *|31 - 0 | |
| 54 | *|ext_msg| |
| 55 | ******************************************/ |
| 56 | static s32 FillH2CCmd_88E(struct adapter *adapt, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer) |
| 57 | { |
| 58 | u8 bcmd_down = false; |
| 59 | s32 retry_cnts = 100; |
| 60 | u8 h2c_box_num; |
| 61 | u32 msgbox_addr; |
| 62 | u32 msgbox_ex_addr; |
| 63 | struct hal_data_8188e *haldata = GET_HAL_DATA(adapt); |
| 64 | u8 cmd_idx, ext_cmd_len; |
| 65 | u32 h2c_cmd = 0; |
| 66 | u32 h2c_cmd_ex = 0; |
| 67 | s32 ret = _FAIL; |
| 68 | |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 69 | |
| 70 | if (!adapt->bFWReady) { |
| 71 | DBG_88E("FillH2CCmd_88E(): return H2C cmd because fw is not ready\n"); |
| 72 | return ret; |
| 73 | } |
| 74 | |
| 75 | if (!pCmdBuffer) |
| 76 | goto exit; |
| 77 | if (CmdLen > RTL88E_MAX_CMD_LEN) |
| 78 | goto exit; |
| 79 | if (adapt->bSurpriseRemoved) |
| 80 | goto exit; |
| 81 | |
| 82 | /* pay attention to if race condition happened in H2C cmd setting. */ |
| 83 | do { |
| 84 | h2c_box_num = haldata->LastHMEBoxNum; |
| 85 | |
| 86 | if (!_is_fw_read_cmd_down(adapt, h2c_box_num)) { |
| 87 | DBG_88E(" fw read cmd failed...\n"); |
| 88 | goto exit; |
| 89 | } |
| 90 | |
| 91 | *(u8 *)(&h2c_cmd) = ElementID; |
| 92 | |
| 93 | if (CmdLen <= 3) { |
| 94 | memcpy((u8 *)(&h2c_cmd)+1, pCmdBuffer, CmdLen); |
| 95 | } else { |
| 96 | memcpy((u8 *)(&h2c_cmd)+1, pCmdBuffer, 3); |
| 97 | ext_cmd_len = CmdLen-3; |
| 98 | memcpy((u8 *)(&h2c_cmd_ex), pCmdBuffer+3, ext_cmd_len); |
| 99 | |
| 100 | /* Write Ext command */ |
| 101 | msgbox_ex_addr = REG_HMEBOX_EXT_0 + (h2c_box_num * RTL88E_EX_MESSAGE_BOX_SIZE); |
| 102 | for (cmd_idx = 0; cmd_idx < ext_cmd_len; cmd_idx++) { |
navin patidar | e76484d | 2014-06-11 22:51:33 +0530 | [diff] [blame] | 103 | usb_write8(adapt, msgbox_ex_addr+cmd_idx, *((u8 *)(&h2c_cmd_ex)+cmd_idx)); |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 104 | } |
| 105 | } |
| 106 | /* Write command */ |
| 107 | msgbox_addr = REG_HMEBOX_0 + (h2c_box_num * RTL88E_MESSAGE_BOX_SIZE); |
| 108 | for (cmd_idx = 0; cmd_idx < RTL88E_MESSAGE_BOX_SIZE; cmd_idx++) { |
navin patidar | e76484d | 2014-06-11 22:51:33 +0530 | [diff] [blame] | 109 | usb_write8(adapt, msgbox_addr+cmd_idx, *((u8 *)(&h2c_cmd)+cmd_idx)); |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 110 | } |
| 111 | bcmd_down = true; |
| 112 | |
| 113 | haldata->LastHMEBoxNum = (h2c_box_num+1) % RTL88E_MAX_H2C_BOX_NUMS; |
| 114 | |
| 115 | } while ((!bcmd_down) && (retry_cnts--)); |
| 116 | |
| 117 | ret = _SUCCESS; |
| 118 | |
| 119 | exit: |
| 120 | |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 121 | |
| 122 | return ret; |
| 123 | } |
| 124 | |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 125 | /* bitmap[0:27] = tx_rate_bitmap */ |
| 126 | /* bitmap[28:31]= Rate Adaptive id */ |
| 127 | /* arg[0:4] = macid */ |
| 128 | /* arg[5] = Short GI */ |
| 129 | void rtl8188e_Add_RateATid(struct adapter *pAdapter, u32 bitmap, u8 arg, u8 rssi_level) |
| 130 | { |
| 131 | struct hal_data_8188e *haldata = GET_HAL_DATA(pAdapter); |
| 132 | |
| 133 | u8 macid, init_rate, raid, shortGIrate = false; |
| 134 | |
| 135 | macid = arg&0x1f; |
| 136 | |
| 137 | raid = (bitmap>>28) & 0x0f; |
| 138 | bitmap &= 0x0fffffff; |
| 139 | |
| 140 | if (rssi_level != DM_RATR_STA_INIT) |
| 141 | bitmap = ODM_Get_Rate_Bitmap(&haldata->odmpriv, macid, bitmap, rssi_level); |
| 142 | |
| 143 | bitmap |= ((raid<<28)&0xf0000000); |
| 144 | |
| 145 | init_rate = get_highest_rate_idx(bitmap&0x0fffffff)&0x3f; |
| 146 | |
Anish Bhatt | 9c68ed0 | 2015-10-18 22:51:41 -0700 | [diff] [blame] | 147 | shortGIrate = (arg & BIT(5)) ? true : false; |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 148 | |
| 149 | if (shortGIrate) |
| 150 | init_rate |= BIT(6); |
| 151 | |
| 152 | raid = (bitmap>>28) & 0x0f; |
| 153 | |
| 154 | bitmap &= 0x0fffffff; |
| 155 | |
| 156 | DBG_88E("%s=> mac_id:%d, raid:%d, ra_bitmap=0x%x, shortGIrate=0x%02x\n", |
| 157 | __func__, macid, raid, bitmap, shortGIrate); |
| 158 | |
| 159 | ODM_RA_UpdateRateInfo_8188E(&(haldata->odmpriv), macid, raid, bitmap, shortGIrate); |
| 160 | } |
| 161 | |
| 162 | void rtl8188e_set_FwPwrMode_cmd(struct adapter *adapt, u8 Mode) |
| 163 | { |
| 164 | struct setpwrmode_parm H2CSetPwrMode; |
| 165 | struct pwrctrl_priv *pwrpriv = &adapt->pwrctrlpriv; |
| 166 | u8 RLBM = 0; /* 0:Min, 1:Max, 2:User define */ |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 167 | |
| 168 | DBG_88E("%s: Mode=%d SmartPS=%d UAPSD=%d\n", __func__, |
| 169 | Mode, pwrpriv->smart_ps, adapt->registrypriv.uapsd_enable); |
| 170 | |
| 171 | switch (Mode) { |
| 172 | case PS_MODE_ACTIVE: |
| 173 | H2CSetPwrMode.Mode = 0; |
| 174 | break; |
| 175 | case PS_MODE_MIN: |
| 176 | H2CSetPwrMode.Mode = 1; |
| 177 | break; |
| 178 | case PS_MODE_MAX: |
| 179 | RLBM = 1; |
| 180 | H2CSetPwrMode.Mode = 1; |
| 181 | break; |
| 182 | case PS_MODE_DTIM: |
| 183 | RLBM = 2; |
| 184 | H2CSetPwrMode.Mode = 1; |
| 185 | break; |
| 186 | case PS_MODE_UAPSD_WMM: |
| 187 | H2CSetPwrMode.Mode = 2; |
| 188 | break; |
| 189 | default: |
| 190 | H2CSetPwrMode.Mode = 0; |
| 191 | break; |
| 192 | } |
| 193 | |
| 194 | H2CSetPwrMode.SmartPS_RLBM = (((pwrpriv->smart_ps<<4)&0xf0) | (RLBM & 0x0f)); |
| 195 | |
| 196 | H2CSetPwrMode.AwakeInterval = 1; |
| 197 | |
| 198 | H2CSetPwrMode.bAllQueueUAPSD = adapt->registrypriv.uapsd_enable; |
| 199 | |
| 200 | if (Mode > 0) |
| 201 | H2CSetPwrMode.PwrState = 0x00;/* AllON(0x0C), RFON(0x04), RFOFF(0x00) */ |
| 202 | else |
| 203 | H2CSetPwrMode.PwrState = 0x0C;/* AllON(0x0C), RFON(0x04), RFOFF(0x00) */ |
| 204 | |
| 205 | FillH2CCmd_88E(adapt, H2C_PS_PWR_MODE, sizeof(H2CSetPwrMode), (u8 *)&H2CSetPwrMode); |
| 206 | |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 207 | } |
| 208 | |
| 209 | void rtl8188e_set_FwMediaStatus_cmd(struct adapter *adapt, __le16 mstatus_rpt) |
| 210 | { |
| 211 | u8 opmode, macid; |
| 212 | u16 mst_rpt = le16_to_cpu(mstatus_rpt); |
Jia He | 7be921a2 | 2014-11-04 09:39:58 +0800 | [diff] [blame] | 213 | opmode = (u8)mst_rpt; |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 214 | macid = (u8)(mst_rpt >> 8); |
| 215 | |
| 216 | DBG_88E("### %s: MStatus=%x MACID=%d\n", __func__, opmode, macid); |
| 217 | FillH2CCmd_88E(adapt, H2C_COM_MEDIA_STATUS_RPT, sizeof(mst_rpt), (u8 *)&mst_rpt); |
| 218 | } |
| 219 | |
| 220 | static void ConstructBeacon(struct adapter *adapt, u8 *pframe, u32 *pLength) |
| 221 | { |
| 222 | struct rtw_ieee80211_hdr *pwlanhdr; |
Larry Finger | c4af455 | 2013-10-23 22:31:35 -0500 | [diff] [blame] | 223 | __le16 *fctrl; |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 224 | u32 rate_len, pktlen; |
| 225 | struct mlme_ext_priv *pmlmeext = &(adapt->mlmeextpriv); |
| 226 | struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); |
| 227 | struct wlan_bssid_ex *cur_network = &(pmlmeinfo->network); |
| 228 | u8 bc_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; |
| 229 | |
| 230 | pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; |
| 231 | |
| 232 | fctrl = &(pwlanhdr->frame_ctl); |
| 233 | *(fctrl) = 0; |
| 234 | |
| 235 | memcpy(pwlanhdr->addr1, bc_addr, ETH_ALEN); |
| 236 | memcpy(pwlanhdr->addr2, myid(&(adapt->eeprompriv)), ETH_ALEN); |
Abel Moyo | 74df1cd | 2014-12-04 14:13:21 +0100 | [diff] [blame] | 237 | memcpy(pwlanhdr->addr3, cur_network->MacAddress, ETH_ALEN); |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 238 | |
| 239 | SetSeqNum(pwlanhdr, 0/*pmlmeext->mgnt_seq*/); |
| 240 | SetFrameSubType(pframe, WIFI_BEACON); |
| 241 | |
| 242 | pframe += sizeof(struct rtw_ieee80211_hdr_3addr); |
| 243 | pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); |
| 244 | |
| 245 | /* timestamp will be inserted by hardware */ |
| 246 | pframe += 8; |
| 247 | pktlen += 8; |
| 248 | |
| 249 | /* beacon interval: 2 bytes */ |
| 250 | memcpy(pframe, (unsigned char *)(rtw_get_beacon_interval_from_ie(cur_network->IEs)), 2); |
| 251 | |
| 252 | pframe += 2; |
| 253 | pktlen += 2; |
| 254 | |
| 255 | /* capability info: 2 bytes */ |
| 256 | memcpy(pframe, (unsigned char *)(rtw_get_capability_from_ie(cur_network->IEs)), 2); |
| 257 | |
| 258 | pframe += 2; |
| 259 | pktlen += 2; |
| 260 | |
| 261 | if ((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE) { |
| 262 | pktlen += cur_network->IELength - sizeof(struct ndis_802_11_fixed_ie); |
| 263 | memcpy(pframe, cur_network->IEs+sizeof(struct ndis_802_11_fixed_ie), pktlen); |
| 264 | |
| 265 | goto _ConstructBeacon; |
| 266 | } |
| 267 | |
| 268 | /* below for ad-hoc mode */ |
| 269 | |
| 270 | /* SSID */ |
| 271 | pframe = rtw_set_ie(pframe, _SSID_IE_, cur_network->Ssid.SsidLength, cur_network->Ssid.Ssid, &pktlen); |
| 272 | |
| 273 | /* supported rates... */ |
| 274 | rate_len = rtw_get_rateset_len(cur_network->SupportedRates); |
Ivan Safonov | ad8d8cd | 2015-10-27 22:18:10 +0700 | [diff] [blame] | 275 | pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_, min_t(u32, rate_len, 8), cur_network->SupportedRates, &pktlen); |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 276 | |
| 277 | /* DS parameter set */ |
| 278 | pframe = rtw_set_ie(pframe, _DSSET_IE_, 1, (unsigned char *)&(cur_network->Configuration.DSConfig), &pktlen); |
| 279 | |
| 280 | if ((pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE) { |
| 281 | u32 ATIMWindow; |
| 282 | /* IBSS Parameter Set... */ |
| 283 | ATIMWindow = 0; |
| 284 | pframe = rtw_set_ie(pframe, _IBSS_PARA_IE_, 2, (unsigned char *)(&ATIMWindow), &pktlen); |
| 285 | } |
| 286 | |
| 287 | /* todo: ERP IE */ |
| 288 | |
| 289 | /* EXTERNDED SUPPORTED RATE */ |
| 290 | if (rate_len > 8) |
| 291 | pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_, (rate_len - 8), (cur_network->SupportedRates + 8), &pktlen); |
| 292 | |
| 293 | /* todo:HT for adhoc */ |
| 294 | |
| 295 | _ConstructBeacon: |
| 296 | |
| 297 | if ((pktlen + TXDESC_SIZE) > 512) { |
| 298 | DBG_88E("beacon frame too large\n"); |
| 299 | return; |
| 300 | } |
| 301 | |
| 302 | *pLength = pktlen; |
| 303 | } |
| 304 | |
| 305 | static void ConstructPSPoll(struct adapter *adapt, u8 *pframe, u32 *pLength) |
| 306 | { |
| 307 | struct rtw_ieee80211_hdr *pwlanhdr; |
| 308 | struct mlme_ext_priv *pmlmeext = &(adapt->mlmeextpriv); |
| 309 | struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); |
Larry Finger | c4af455 | 2013-10-23 22:31:35 -0500 | [diff] [blame] | 310 | __le16 *fctrl; |
Abel Moyo | 74df1cd | 2014-12-04 14:13:21 +0100 | [diff] [blame] | 311 | struct wlan_bssid_ex *pnetwork = &(pmlmeinfo->network); |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 312 | |
| 313 | pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; |
| 314 | |
| 315 | /* Frame control. */ |
| 316 | fctrl = &(pwlanhdr->frame_ctl); |
| 317 | *(fctrl) = 0; |
| 318 | SetPwrMgt(fctrl); |
| 319 | SetFrameSubType(pframe, WIFI_PSPOLL); |
| 320 | |
| 321 | /* AID. */ |
| 322 | SetDuration(pframe, (pmlmeinfo->aid | 0xc000)); |
| 323 | |
| 324 | /* BSSID. */ |
Abel Moyo | 74df1cd | 2014-12-04 14:13:21 +0100 | [diff] [blame] | 325 | memcpy(pwlanhdr->addr1, pnetwork->MacAddress, ETH_ALEN); |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 326 | |
| 327 | /* TA. */ |
| 328 | memcpy(pwlanhdr->addr2, myid(&(adapt->eeprompriv)), ETH_ALEN); |
| 329 | |
| 330 | *pLength = 16; |
| 331 | } |
| 332 | |
| 333 | static void ConstructNullFunctionData(struct adapter *adapt, u8 *pframe, |
| 334 | u32 *pLength, |
| 335 | u8 *StaAddr, |
| 336 | u8 bQoS, |
| 337 | u8 AC, |
| 338 | u8 bEosp, |
| 339 | u8 bForcePowerSave) |
| 340 | { |
| 341 | struct rtw_ieee80211_hdr *pwlanhdr; |
Larry Finger | c4af455 | 2013-10-23 22:31:35 -0500 | [diff] [blame] | 342 | __le16 *fctrl; |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 343 | u32 pktlen; |
| 344 | struct mlme_priv *pmlmepriv = &adapt->mlmepriv; |
| 345 | struct wlan_network *cur_network = &pmlmepriv->cur_network; |
| 346 | struct mlme_ext_priv *pmlmeext = &(adapt->mlmeextpriv); |
| 347 | struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); |
Abel Moyo | 74df1cd | 2014-12-04 14:13:21 +0100 | [diff] [blame] | 348 | struct wlan_bssid_ex *pnetwork = &(pmlmeinfo->network); |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 349 | |
| 350 | pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; |
| 351 | |
| 352 | fctrl = &pwlanhdr->frame_ctl; |
| 353 | *(fctrl) = 0; |
| 354 | if (bForcePowerSave) |
| 355 | SetPwrMgt(fctrl); |
| 356 | |
| 357 | switch (cur_network->network.InfrastructureMode) { |
| 358 | case Ndis802_11Infrastructure: |
| 359 | SetToDs(fctrl); |
Abel Moyo | 74df1cd | 2014-12-04 14:13:21 +0100 | [diff] [blame] | 360 | memcpy(pwlanhdr->addr1, pnetwork->MacAddress, ETH_ALEN); |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 361 | memcpy(pwlanhdr->addr2, myid(&(adapt->eeprompriv)), ETH_ALEN); |
| 362 | memcpy(pwlanhdr->addr3, StaAddr, ETH_ALEN); |
| 363 | break; |
| 364 | case Ndis802_11APMode: |
| 365 | SetFrDs(fctrl); |
| 366 | memcpy(pwlanhdr->addr1, StaAddr, ETH_ALEN); |
Abel Moyo | 74df1cd | 2014-12-04 14:13:21 +0100 | [diff] [blame] | 367 | memcpy(pwlanhdr->addr2, pnetwork->MacAddress, ETH_ALEN); |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 368 | memcpy(pwlanhdr->addr3, myid(&(adapt->eeprompriv)), ETH_ALEN); |
| 369 | break; |
| 370 | case Ndis802_11IBSS: |
| 371 | default: |
| 372 | memcpy(pwlanhdr->addr1, StaAddr, ETH_ALEN); |
| 373 | memcpy(pwlanhdr->addr2, myid(&(adapt->eeprompriv)), ETH_ALEN); |
Abel Moyo | 74df1cd | 2014-12-04 14:13:21 +0100 | [diff] [blame] | 374 | memcpy(pwlanhdr->addr3, pnetwork->MacAddress, ETH_ALEN); |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 375 | break; |
| 376 | } |
| 377 | |
| 378 | SetSeqNum(pwlanhdr, 0); |
| 379 | |
| 380 | if (bQoS) { |
| 381 | struct rtw_ieee80211_hdr_3addr_qos *pwlanqoshdr; |
| 382 | |
| 383 | SetFrameSubType(pframe, WIFI_QOS_DATA_NULL); |
| 384 | |
| 385 | pwlanqoshdr = (struct rtw_ieee80211_hdr_3addr_qos *)pframe; |
| 386 | SetPriority(&pwlanqoshdr->qc, AC); |
| 387 | SetEOSP(&pwlanqoshdr->qc, bEosp); |
| 388 | |
| 389 | pktlen = sizeof(struct rtw_ieee80211_hdr_3addr_qos); |
| 390 | } else { |
| 391 | SetFrameSubType(pframe, WIFI_DATA_NULL); |
| 392 | |
| 393 | pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); |
| 394 | } |
| 395 | |
| 396 | *pLength = pktlen; |
| 397 | } |
| 398 | |
| 399 | static void ConstructProbeRsp(struct adapter *adapt, u8 *pframe, u32 *pLength, u8 *StaAddr, bool bHideSSID) |
| 400 | { |
| 401 | struct rtw_ieee80211_hdr *pwlanhdr; |
Larry Finger | c4af455 | 2013-10-23 22:31:35 -0500 | [diff] [blame] | 402 | __le16 *fctrl; |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 403 | u8 *mac, *bssid; |
| 404 | u32 pktlen; |
| 405 | struct mlme_ext_priv *pmlmeext = &(adapt->mlmeextpriv); |
| 406 | struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); |
| 407 | struct wlan_bssid_ex *cur_network = &(pmlmeinfo->network); |
| 408 | |
| 409 | pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; |
| 410 | |
| 411 | mac = myid(&(adapt->eeprompriv)); |
| 412 | bssid = cur_network->MacAddress; |
| 413 | |
| 414 | fctrl = &(pwlanhdr->frame_ctl); |
| 415 | *(fctrl) = 0; |
| 416 | memcpy(pwlanhdr->addr1, StaAddr, ETH_ALEN); |
| 417 | memcpy(pwlanhdr->addr2, mac, ETH_ALEN); |
| 418 | memcpy(pwlanhdr->addr3, bssid, ETH_ALEN); |
| 419 | |
| 420 | SetSeqNum(pwlanhdr, 0); |
| 421 | SetFrameSubType(fctrl, WIFI_PROBERSP); |
| 422 | |
| 423 | pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); |
| 424 | pframe += pktlen; |
| 425 | |
| 426 | if (cur_network->IELength > MAX_IE_SZ) |
| 427 | return; |
| 428 | |
| 429 | memcpy(pframe, cur_network->IEs, cur_network->IELength); |
| 430 | pframe += cur_network->IELength; |
| 431 | pktlen += cur_network->IELength; |
| 432 | |
| 433 | *pLength = pktlen; |
| 434 | } |
| 435 | |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 436 | /* */ |
| 437 | /* Description: Fill the reserved packets that FW will use to RSVD page. */ |
| 438 | /* Now we just send 4 types packet to rsvd page. */ |
| 439 | /* (1)Beacon, (2)Ps-poll, (3)Null data, (4)ProbeRsp. */ |
| 440 | /* Input: */ |
| 441 | /* bDLFinished - false: At the first time we will send all the packets as a large packet to Hw, */ |
Masanari Iida | 5e809e5 | 2013-09-27 00:11:45 +0900 | [diff] [blame] | 442 | /* so we need to set the packet length to total length. */ |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 443 | /* true: At the second time, we should send the first packet (default:beacon) */ |
Masanari Iida | 5e809e5 | 2013-09-27 00:11:45 +0900 | [diff] [blame] | 444 | /* to Hw again and set the length in descriptor to the real beacon length. */ |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 445 | /* 2009.10.15 by tynli. */ |
| 446 | static void SetFwRsvdPagePkt(struct adapter *adapt, bool bDLFinished) |
| 447 | { |
| 448 | struct hal_data_8188e *haldata; |
| 449 | struct xmit_frame *pmgntframe; |
| 450 | struct pkt_attrib *pattrib; |
| 451 | struct xmit_priv *pxmitpriv; |
| 452 | struct mlme_ext_priv *pmlmeext; |
| 453 | struct mlme_ext_info *pmlmeinfo; |
| 454 | u32 BeaconLength = 0, ProbeRspLength = 0, PSPollLength; |
| 455 | u32 NullDataLength, QosNullLength; |
| 456 | u8 *ReservedPagePacket; |
| 457 | u8 PageNum, PageNeed, TxDescLen; |
| 458 | u16 BufIndex; |
| 459 | u32 TotalPacketLen; |
| 460 | struct rsvdpage_loc RsvdPageLoc; |
Abel Moyo | 74df1cd | 2014-12-04 14:13:21 +0100 | [diff] [blame] | 461 | struct wlan_bssid_ex *pnetwork; |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 462 | |
| 463 | DBG_88E("%s\n", __func__); |
navin patidar | fadbe0c | 2014-06-22 14:06:23 +0530 | [diff] [blame] | 464 | ReservedPagePacket = kzalloc(1000, GFP_KERNEL); |
Shraddha Barke | e3789b0 | 2015-09-11 10:40:53 +0530 | [diff] [blame] | 465 | if (!ReservedPagePacket) { |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 466 | DBG_88E("%s: alloc ReservedPagePacket fail!\n", __func__); |
| 467 | return; |
| 468 | } |
| 469 | |
| 470 | haldata = GET_HAL_DATA(adapt); |
| 471 | pxmitpriv = &adapt->xmitpriv; |
| 472 | pmlmeext = &adapt->mlmeextpriv; |
| 473 | pmlmeinfo = &pmlmeext->mlmext_info; |
Abel Moyo | 74df1cd | 2014-12-04 14:13:21 +0100 | [diff] [blame] | 474 | pnetwork = &(pmlmeinfo->network); |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 475 | |
| 476 | TxDescLen = TXDESC_SIZE; |
| 477 | PageNum = 0; |
| 478 | |
| 479 | /* 3 (1) beacon * 2 pages */ |
| 480 | BufIndex = TXDESC_OFFSET; |
| 481 | ConstructBeacon(adapt, &ReservedPagePacket[BufIndex], &BeaconLength); |
| 482 | |
| 483 | /* When we count the first page size, we need to reserve description size for the RSVD */ |
| 484 | /* packet, it will be filled in front of the packet in TXPKTBUF. */ |
| 485 | PageNeed = (u8)PageNum_128(TxDescLen + BeaconLength); |
| 486 | /* To reserved 2 pages for beacon buffer. 2010.06.24. */ |
| 487 | if (PageNeed == 1) |
| 488 | PageNeed += 1; |
| 489 | PageNum += PageNeed; |
| 490 | haldata->FwRsvdPageStartOffset = PageNum; |
| 491 | |
| 492 | BufIndex += PageNeed*128; |
| 493 | |
| 494 | /* 3 (2) ps-poll *1 page */ |
| 495 | RsvdPageLoc.LocPsPoll = PageNum; |
| 496 | ConstructPSPoll(adapt, &ReservedPagePacket[BufIndex], &PSPollLength); |
| 497 | rtl8188e_fill_fake_txdesc(adapt, &ReservedPagePacket[BufIndex-TxDescLen], PSPollLength, true, false); |
| 498 | |
| 499 | PageNeed = (u8)PageNum_128(TxDescLen + PSPollLength); |
| 500 | PageNum += PageNeed; |
| 501 | |
| 502 | BufIndex += PageNeed*128; |
| 503 | |
| 504 | /* 3 (3) null data * 1 page */ |
| 505 | RsvdPageLoc.LocNullData = PageNum; |
Abel Moyo | 74df1cd | 2014-12-04 14:13:21 +0100 | [diff] [blame] | 506 | ConstructNullFunctionData(adapt, &ReservedPagePacket[BufIndex], &NullDataLength, pnetwork->MacAddress, false, 0, 0, false); |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 507 | rtl8188e_fill_fake_txdesc(adapt, &ReservedPagePacket[BufIndex-TxDescLen], NullDataLength, false, false); |
| 508 | |
| 509 | PageNeed = (u8)PageNum_128(TxDescLen + NullDataLength); |
| 510 | PageNum += PageNeed; |
| 511 | |
| 512 | BufIndex += PageNeed*128; |
| 513 | |
| 514 | /* 3 (4) probe response * 1page */ |
| 515 | RsvdPageLoc.LocProbeRsp = PageNum; |
Abel Moyo | 74df1cd | 2014-12-04 14:13:21 +0100 | [diff] [blame] | 516 | ConstructProbeRsp(adapt, &ReservedPagePacket[BufIndex], &ProbeRspLength, pnetwork->MacAddress, false); |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 517 | rtl8188e_fill_fake_txdesc(adapt, &ReservedPagePacket[BufIndex-TxDescLen], ProbeRspLength, false, false); |
| 518 | |
| 519 | PageNeed = (u8)PageNum_128(TxDescLen + ProbeRspLength); |
| 520 | PageNum += PageNeed; |
| 521 | |
| 522 | BufIndex += PageNeed*128; |
| 523 | |
| 524 | /* 3 (5) Qos null data */ |
| 525 | RsvdPageLoc.LocQosNull = PageNum; |
| 526 | ConstructNullFunctionData(adapt, &ReservedPagePacket[BufIndex], |
Abel Moyo | 74df1cd | 2014-12-04 14:13:21 +0100 | [diff] [blame] | 527 | &QosNullLength, pnetwork->MacAddress, true, 0, 0, false); |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 528 | rtl8188e_fill_fake_txdesc(adapt, &ReservedPagePacket[BufIndex-TxDescLen], QosNullLength, false, false); |
| 529 | |
| 530 | PageNeed = (u8)PageNum_128(TxDescLen + QosNullLength); |
| 531 | PageNum += PageNeed; |
| 532 | |
| 533 | TotalPacketLen = BufIndex + QosNullLength; |
| 534 | pmgntframe = alloc_mgtxmitframe(pxmitpriv); |
Shraddha Barke | e3789b0 | 2015-09-11 10:40:53 +0530 | [diff] [blame] | 535 | if (!pmgntframe) |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 536 | goto exit; |
| 537 | |
| 538 | /* update attribute */ |
| 539 | pattrib = &pmgntframe->attrib; |
| 540 | update_mgntframe_attrib(adapt, pattrib); |
| 541 | pattrib->qsel = 0x10; |
| 542 | pattrib->last_txcmdsz = TotalPacketLen - TXDESC_OFFSET; |
| 543 | pattrib->pktlen = pattrib->last_txcmdsz; |
| 544 | memcpy(pmgntframe->buf_addr, ReservedPagePacket, TotalPacketLen); |
| 545 | |
| 546 | rtw_hal_mgnt_xmit(adapt, pmgntframe); |
| 547 | |
| 548 | DBG_88E("%s: Set RSVD page location to Fw\n", __func__); |
| 549 | FillH2CCmd_88E(adapt, H2C_COM_RSVD_PAGE, sizeof(RsvdPageLoc), (u8 *)&RsvdPageLoc); |
| 550 | |
| 551 | exit: |
| 552 | kfree(ReservedPagePacket); |
| 553 | } |
| 554 | |
| 555 | void rtl8188e_set_FwJoinBssReport_cmd(struct adapter *adapt, u8 mstatus) |
| 556 | { |
| 557 | struct hal_data_8188e *haldata = GET_HAL_DATA(adapt); |
| 558 | struct mlme_ext_priv *pmlmeext = &(adapt->mlmeextpriv); |
| 559 | struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); |
| 560 | bool bSendBeacon = false; |
| 561 | bool bcn_valid = false; |
| 562 | u8 DLBcnCount = 0; |
| 563 | u32 poll = 0; |
| 564 | |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 565 | |
| 566 | DBG_88E("%s mstatus(%x)\n", __func__, mstatus); |
| 567 | |
| 568 | if (mstatus == 1) { |
| 569 | /* We should set AID, correct TSF, HW seq enable before set JoinBssReport to Fw in 88/92C. */ |
| 570 | /* Suggested by filen. Added by tynli. */ |
navin patidar | 9764ed0 | 2014-06-11 22:51:32 +0530 | [diff] [blame] | 571 | usb_write16(adapt, REG_BCN_PSR_RPT, (0xC000|pmlmeinfo->aid)); |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 572 | /* Do not set TSF again here or vWiFi beacon DMA INT will not work. */ |
| 573 | |
| 574 | /* Set REG_CR bit 8. DMA beacon by SW. */ |
Anish Bhatt | 9c68ed0 | 2015-10-18 22:51:41 -0700 | [diff] [blame] | 575 | haldata->RegCR_1 |= BIT(0); |
navin patidar | e76484d | 2014-06-11 22:51:33 +0530 | [diff] [blame] | 576 | usb_write8(adapt, REG_CR+1, haldata->RegCR_1); |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 577 | |
| 578 | /* Disable Hw protection for a time which revserd for Hw sending beacon. */ |
| 579 | /* Fix download reserved page packet fail that access collision with the protection time. */ |
| 580 | /* 2010.05.11. Added by tynli. */ |
navin patidar | c7b2e99 | 2014-06-11 22:51:36 +0530 | [diff] [blame] | 581 | usb_write8(adapt, REG_BCN_CTRL, usb_read8(adapt, REG_BCN_CTRL)&(~BIT(3))); |
Anish Bhatt | 9c68ed0 | 2015-10-18 22:51:41 -0700 | [diff] [blame] | 582 | usb_write8(adapt, REG_BCN_CTRL, usb_read8(adapt, REG_BCN_CTRL) | BIT(4)); |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 583 | |
Anish Bhatt | 9c68ed0 | 2015-10-18 22:51:41 -0700 | [diff] [blame] | 584 | if (haldata->RegFwHwTxQCtrl & BIT(6)) { |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 585 | DBG_88E("HalDownloadRSVDPage(): There is an Adapter is sending beacon.\n"); |
| 586 | bSendBeacon = true; |
| 587 | } |
| 588 | |
| 589 | /* Set FWHW_TXQ_CTRL 0x422[6]=0 to tell Hw the packet is not a real beacon frame. */ |
Anish Bhatt | 9c68ed0 | 2015-10-18 22:51:41 -0700 | [diff] [blame] | 590 | usb_write8(adapt, REG_FWHW_TXQ_CTRL+2, (haldata->RegFwHwTxQCtrl&(~BIT(6)))); |
| 591 | haldata->RegFwHwTxQCtrl &= (~BIT(6)); |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 592 | |
| 593 | /* Clear beacon valid check bit. */ |
| 594 | rtw_hal_set_hwreg(adapt, HW_VAR_BCN_VALID, NULL); |
| 595 | DLBcnCount = 0; |
| 596 | poll = 0; |
| 597 | do { |
| 598 | /* download rsvd page. */ |
| 599 | SetFwRsvdPagePkt(adapt, false); |
| 600 | DLBcnCount++; |
| 601 | do { |
Larry Finger | e8ab621 | 2013-12-22 17:36:33 -0600 | [diff] [blame] | 602 | yield(); |
Larry Finger | 4063642 | 2013-12-19 22:38:42 -0600 | [diff] [blame] | 603 | /* mdelay(10); */ |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 604 | /* check rsvd page download OK. */ |
| 605 | rtw_hal_get_hwreg(adapt, HW_VAR_BCN_VALID, (u8 *)(&bcn_valid)); |
| 606 | poll++; |
| 607 | } while (!bcn_valid && (poll%10) != 0 && !adapt->bSurpriseRemoved && !adapt->bDriverStopped); |
| 608 | } while (!bcn_valid && DLBcnCount <= 100 && !adapt->bSurpriseRemoved && !adapt->bDriverStopped); |
| 609 | |
| 610 | if (adapt->bSurpriseRemoved || adapt->bDriverStopped) |
| 611 | ; |
| 612 | else if (!bcn_valid) |
| 613 | DBG_88E("%s: 1 Download RSVD page failed! DLBcnCount:%u, poll:%u\n", __func__, DLBcnCount, poll); |
| 614 | else |
| 615 | DBG_88E("%s: 1 Download RSVD success! DLBcnCount:%u, poll:%u\n", __func__, DLBcnCount, poll); |
| 616 | /* */ |
| 617 | /* We just can send the reserved page twice during the time that Tx thread is stopped (e.g. pnpsetpower) */ |
Masanari Iida | 5e809e5 | 2013-09-27 00:11:45 +0900 | [diff] [blame] | 618 | /* because we need to free the Tx BCN Desc which is used by the first reserved page packet. */ |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 619 | /* At run time, we cannot get the Tx Desc until it is released in TxHandleInterrupt() so we will return */ |
| 620 | /* the beacon TCB in the following code. 2011.11.23. by tynli. */ |
| 621 | /* */ |
| 622 | |
| 623 | /* Enable Bcn */ |
Anish Bhatt | 9c68ed0 | 2015-10-18 22:51:41 -0700 | [diff] [blame] | 624 | usb_write8(adapt, REG_BCN_CTRL, usb_read8(adapt, REG_BCN_CTRL) | BIT(3)); |
navin patidar | c7b2e99 | 2014-06-11 22:51:36 +0530 | [diff] [blame] | 625 | usb_write8(adapt, REG_BCN_CTRL, usb_read8(adapt, REG_BCN_CTRL)&(~BIT(4))); |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 626 | |
| 627 | /* To make sure that if there exists an adapter which would like to send beacon. */ |
| 628 | /* If exists, the origianl value of 0x422[6] will be 1, we should check this to */ |
| 629 | /* prevent from setting 0x422[6] to 0 after download reserved page, or it will cause */ |
| 630 | /* the beacon cannot be sent by HW. */ |
| 631 | /* 2010.06.23. Added by tynli. */ |
| 632 | if (bSendBeacon) { |
Anish Bhatt | 9c68ed0 | 2015-10-18 22:51:41 -0700 | [diff] [blame] | 633 | usb_write8(adapt, REG_FWHW_TXQ_CTRL+2, (haldata->RegFwHwTxQCtrl | BIT(6))); |
| 634 | haldata->RegFwHwTxQCtrl |= BIT(6); |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 635 | } |
| 636 | |
| 637 | /* Update RSVD page location H2C to Fw. */ |
| 638 | if (bcn_valid) { |
| 639 | rtw_hal_set_hwreg(adapt, HW_VAR_BCN_VALID, NULL); |
| 640 | DBG_88E("Set RSVD page location to Fw.\n"); |
| 641 | } |
| 642 | |
| 643 | /* Do not enable HW DMA BCN or it will cause Pcie interface hang by timing issue. 2011.11.24. by tynli. */ |
| 644 | /* Clear CR[8] or beacon packet will not be send to TxBuf anymore. */ |
Anish Bhatt | 9c68ed0 | 2015-10-18 22:51:41 -0700 | [diff] [blame] | 645 | haldata->RegCR_1 &= (~BIT(0)); |
navin patidar | e76484d | 2014-06-11 22:51:33 +0530 | [diff] [blame] | 646 | usb_write8(adapt, REG_CR+1, haldata->RegCR_1); |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 647 | } |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 648 | } |