1 /******************************************************************************
3 * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved.
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.
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
14 ******************************************************************************/
15 #define _RTL8723A_CMD_C_
17 #include <osdep_service.h>
18 #include <drv_types.h>
19 #include <recv_osdep.h>
20 #include <mlme_osdep.h>
21 #include <rtl8723a_hal.h>
22 #include <usb_ops_linux.h>
24 #define RTL92C_MAX_H2C_BOX_NUMS 4
25 #define RTL92C_MAX_CMD_LEN 5
26 #define MESSAGE_BOX_SIZE 4
27 #define EX_MESSAGE_BOX_SIZE 2
29 static u8 _is_fw_read_cmd_down(struct rtw_adapter *padapter, u8 msgbox_num)
36 valid = rtl8723au_read8(padapter, REG_HMETFR) & BIT(msgbox_num);
39 } while ((!read_down) && (retry_cnts--));
44 /*****************************************
46 *| 31 - 8 |7 | 6 - 0 |
47 *| h2c_msg |Ext_bit |CMD_ID |
49 ******************************************/
50 int FillH2CCmd(struct rtw_adapter *padapter, u8 ElementID, u32 CmdLen,
58 struct hal_data_8723a *pHalData;
63 padapter = GET_PRIMARY_ADAPTER(padapter);
64 pHalData = GET_HAL_DATA(padapter);
66 mutex_lock(&adapter_to_dvobj(padapter)->h2c_fwcmd_mutex);
70 if (CmdLen > RTL92C_MAX_CMD_LEN)
72 if (padapter->bSurpriseRemoved == true)
75 /* pay attention to if race condition happened in H2C cmd setting. */
77 h2c_box_num = pHalData->LastHMEBoxNum;
79 if (!_is_fw_read_cmd_down(padapter, h2c_box_num)) {
80 DBG_8723A(" fw read cmd failed...\n");
85 memcpy((u8 *)(&h2c_cmd)+1, pCmdBuffer, CmdLen);
87 memcpy((u8 *)(&h2c_cmd_ex), pCmdBuffer, EX_MESSAGE_BOX_SIZE);
88 memcpy((u8 *)(&h2c_cmd)+1, pCmdBuffer+2, (CmdLen-EX_MESSAGE_BOX_SIZE));
89 *(u8 *)(&h2c_cmd) |= BIT(7);
92 *(u8 *)(&h2c_cmd) |= ElementID;
94 if (h2c_cmd & BIT(7)) {
95 msgbox_ex_addr = REG_HMEBOX_EXT_0 + (h2c_box_num * EX_MESSAGE_BOX_SIZE);
96 h2c_cmd_ex = le16_to_cpu(h2c_cmd_ex);
97 rtl8723au_write16(padapter, msgbox_ex_addr, h2c_cmd_ex);
99 msgbox_addr = REG_HMEBOX_0 + (h2c_box_num * MESSAGE_BOX_SIZE);
100 h2c_cmd = le32_to_cpu(h2c_cmd);
101 rtl8723au_write32(padapter, msgbox_addr, h2c_cmd);
105 pHalData->LastHMEBoxNum = (h2c_box_num+1) % RTL92C_MAX_H2C_BOX_NUMS;
107 } while ((!bcmd_down) && (retry_cnts--));
112 mutex_unlock(&adapter_to_dvobj(padapter)->h2c_fwcmd_mutex);
116 int rtl8723a_set_rssi_cmd(struct rtw_adapter *padapter, u8 *param)
118 *((u32 *)param) = cpu_to_le32(*((u32 *)param));
120 FillH2CCmd(padapter, RSSI_SETTING_EID, 3, param);
125 int rtl8723a_set_raid_cmd(struct rtw_adapter *padapter, u32 mask, u8 arg)
130 put_unaligned_le32(mask, buf);
133 FillH2CCmd(padapter, MACID_CONFIG_EID, 5, buf);
138 /* bitmap[0:27] = tx_rate_bitmap */
139 /* bitmap[28:31]= Rate Adaptive id */
140 /* arg[0:4] = macid */
141 /* arg[5] = Short GI */
142 void rtl8723a_add_rateatid(struct rtw_adapter *pAdapter, u32 bitmap, u8 arg, u8 rssi_level)
144 struct hal_data_8723a *pHalData = GET_HAL_DATA(pAdapter);
145 u8 macid = arg & 0x1f;
146 u32 raid = bitmap & 0xf0000000;
148 bitmap &= 0x0fffffff;
149 if (rssi_level != DM_RATR_STA_INIT)
150 bitmap = ODM_Get_Rate_Bitmap23a(pHalData, macid, bitmap,
155 rtl8723a_set_raid_cmd(pAdapter, bitmap, arg);
158 void rtl8723a_set_FwPwrMode_cmd(struct rtw_adapter *padapter, u8 Mode)
160 struct setpwrmode_parm H2CSetPwrMode;
161 struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv;
162 struct hal_data_8723a *pHalData = GET_HAL_DATA(padapter);
164 DBG_8723A("%s: Mode =%d SmartPS =%d UAPSD =%d BcnMode = 0x%02x\n", __func__,
165 Mode, pwrpriv->smart_ps, padapter->registrypriv.uapsd_enable, pwrpriv->bcn_ant_mode);
167 /* Forece leave RF low power mode for 1T1R to
168 prevent conficting setting in Fw power */
169 /* saving sequence. 2010.06.07. Added by tynli.
170 Suggested by SD3 yschang. */
171 if (Mode != PS_MODE_ACTIVE && pHalData->rf_type != RF_2T2R)
172 ODM_RF_Saving23a(&pHalData->odmpriv, true);
174 H2CSetPwrMode.Mode = Mode;
175 H2CSetPwrMode.SmartPS = pwrpriv->smart_ps;
176 H2CSetPwrMode.AwakeInterval = 1;
177 H2CSetPwrMode.bAllQueueUAPSD = padapter->registrypriv.uapsd_enable;
178 H2CSetPwrMode.BcnAntMode = pwrpriv->bcn_ant_mode;
180 FillH2CCmd(padapter, SET_PWRMODE_EID, sizeof(H2CSetPwrMode), (u8 *)&H2CSetPwrMode);
185 ConstructBeacon(struct rtw_adapter *padapter, u8 *pframe, u32 *pLength)
187 struct ieee80211_mgmt *mgmt;
188 u32 rate_len, pktlen;
189 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
190 struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
191 struct wlan_bssid_ex *cur_network = &pmlmeinfo->network;
192 u8 bc_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff};
194 /* DBG_8723A("%s\n", __func__); */
196 mgmt = (struct ieee80211_mgmt *)pframe;
198 mgmt->frame_control =
199 cpu_to_le16(IEEE80211_FTYPE_MGMT | IEEE80211_STYPE_BEACON);
201 ether_addr_copy(mgmt->da, bc_addr);
202 ether_addr_copy(mgmt->sa, myid(&padapter->eeprompriv));
203 ether_addr_copy(mgmt->bssid, get_my_bssid23a(cur_network));
205 /* A Beacon frame shouldn't have fragment bits set */
208 /* timestamp will be inserted by hardware */
210 put_unaligned_le16(cur_network->beacon_interval,
211 &mgmt->u.beacon.beacon_int);
213 put_unaligned_le16(cur_network->capability,
214 &mgmt->u.beacon.capab_info);
216 pframe = mgmt->u.beacon.variable;
217 pktlen = offsetof(struct ieee80211_mgmt, u.beacon.variable);
219 if ((pmlmeinfo->state&0x03) == MSR_AP) {
220 /* DBG_8723A("ie len =%d\n", cur_network->IELength); */
221 pktlen += cur_network->IELength;
222 memcpy(pframe, cur_network->IEs, pktlen);
224 goto _ConstructBeacon;
227 /* below for ad-hoc mode */
230 pframe = rtw_set_ie23a(pframe, WLAN_EID_SSID,
231 cur_network->Ssid.ssid_len,
232 cur_network->Ssid.ssid, &pktlen);
234 /* supported rates... */
235 rate_len = rtw_get_rateset_len23a(cur_network->SupportedRates);
236 pframe = rtw_set_ie23a(pframe, WLAN_EID_SUPP_RATES, ((rate_len > 8) ?
237 8 : rate_len), cur_network->SupportedRates, &pktlen);
239 /* DS parameter set */
240 pframe = rtw_set_ie23a(pframe, WLAN_EID_DS_PARAMS, 1, (unsigned char *)
241 &cur_network->DSConfig, &pktlen);
243 if ((pmlmeinfo->state&0x03) == MSR_ADHOC) {
245 /* IBSS Parameter Set... */
246 /* ATIMWindow = cur->ATIMWindow; */
248 pframe = rtw_set_ie23a(pframe, WLAN_EID_IBSS_PARAMS, 2,
249 (unsigned char *)&ATIMWindow, &pktlen);
254 /* EXTERNDED SUPPORTED RATE */
256 pframe = rtw_set_ie23a(pframe, WLAN_EID_EXT_SUPP_RATES,
258 (cur_network->SupportedRates + 8),
261 /* todo:HT for adhoc */
265 if ((pktlen + TXDESC_SIZE) > 512) {
266 DBG_8723A("beacon frame too large\n");
272 /* DBG_8723A("%s bcn_sz =%d\n", __func__, pktlen); */
276 static void ConstructPSPoll(struct rtw_adapter *padapter,
277 u8 *pframe, u32 *pLength)
279 struct ieee80211_hdr *pwlanhdr;
280 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
281 struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
283 pwlanhdr = (struct ieee80211_hdr *)pframe;
286 pwlanhdr->frame_control =
287 cpu_to_le16(IEEE80211_FTYPE_CTL | IEEE80211_STYPE_PSPOLL);
288 pwlanhdr->frame_control |= cpu_to_le16(IEEE80211_FCTL_PM);
291 pwlanhdr->duration_id = cpu_to_le16(pmlmeinfo->aid | 0xc000);
294 memcpy(pwlanhdr->addr1, get_my_bssid23a(&pmlmeinfo->network), ETH_ALEN);
297 memcpy(pwlanhdr->addr2, myid(&padapter->eeprompriv), ETH_ALEN);
303 ConstructNullFunctionData(struct rtw_adapter *padapter, u8 *pframe,
304 u32 *pLength, u8 *StaAddr, u8 bQoS, u8 AC,
305 u8 bEosp, u8 bForcePowerSave)
307 struct ieee80211_hdr *pwlanhdr;
309 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
310 struct wlan_network *cur_network = &pmlmepriv->cur_network;
311 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
312 struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
314 pwlanhdr = (struct ieee80211_hdr *)pframe;
316 pwlanhdr->frame_control = 0;
317 pwlanhdr->seq_ctrl = 0;
320 pwlanhdr->frame_control |= cpu_to_le16(IEEE80211_FCTL_PM);
322 switch (cur_network->network.ifmode) {
323 case NL80211_IFTYPE_P2P_CLIENT:
324 case NL80211_IFTYPE_STATION:
325 pwlanhdr->frame_control |= cpu_to_le16(IEEE80211_FCTL_TODS);
326 memcpy(pwlanhdr->addr1,
327 get_my_bssid23a(&pmlmeinfo->network), ETH_ALEN);
328 memcpy(pwlanhdr->addr2, myid(&padapter->eeprompriv),
330 memcpy(pwlanhdr->addr3, StaAddr, ETH_ALEN);
332 case NL80211_IFTYPE_P2P_GO:
333 case NL80211_IFTYPE_AP:
334 pwlanhdr->frame_control |= cpu_to_le16(IEEE80211_FCTL_FROMDS);
335 memcpy(pwlanhdr->addr1, StaAddr, ETH_ALEN);
336 memcpy(pwlanhdr->addr2,
337 get_my_bssid23a(&pmlmeinfo->network), ETH_ALEN);
338 memcpy(pwlanhdr->addr3, myid(&padapter->eeprompriv),
341 case NL80211_IFTYPE_ADHOC:
343 memcpy(pwlanhdr->addr1, StaAddr, ETH_ALEN);
344 memcpy(pwlanhdr->addr2, myid(&padapter->eeprompriv), ETH_ALEN);
345 memcpy(pwlanhdr->addr3,
346 get_my_bssid23a(&pmlmeinfo->network), ETH_ALEN);
351 struct ieee80211_qos_hdr *qoshdr;
352 qoshdr = (struct ieee80211_qos_hdr *)pframe;
354 qoshdr->frame_control |=
355 cpu_to_le16(IEEE80211_FTYPE_DATA |
356 IEEE80211_STYPE_QOS_NULLFUNC);
358 qoshdr->qos_ctrl = cpu_to_le16(AC & IEEE80211_QOS_CTL_TID_MASK);
360 qoshdr->qos_ctrl |= cpu_to_le16(IEEE80211_QOS_CTL_EOSP);
362 pktlen = sizeof(struct ieee80211_qos_hdr);
364 pwlanhdr->frame_control |=
365 cpu_to_le16(IEEE80211_FTYPE_DATA |
366 IEEE80211_STYPE_NULLFUNC);
368 pktlen = sizeof(struct ieee80211_hdr_3addr);
374 static void ConstructProbeRsp(struct rtw_adapter *padapter, u8 *pframe,
375 u32 *pLength, u8 *StaAddr, bool bHideSSID)
377 struct ieee80211_mgmt *mgmt;
380 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
381 struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
382 struct wlan_bssid_ex *cur_network = &pmlmeinfo->network;
384 /* DBG_8723A("%s\n", __func__); */
386 mgmt = (struct ieee80211_mgmt *)pframe;
388 mac = myid(&padapter->eeprompriv);
389 bssid = cur_network->MacAddress;
391 mgmt->frame_control =
392 cpu_to_le16(IEEE80211_FTYPE_MGMT | IEEE80211_STYPE_PROBE_RESP);
396 memcpy(mgmt->da, StaAddr, ETH_ALEN);
397 memcpy(mgmt->sa, mac, ETH_ALEN);
398 memcpy(mgmt->bssid, bssid, ETH_ALEN);
400 put_unaligned_le64(cur_network->tsf,
401 &mgmt->u.probe_resp.timestamp);
402 put_unaligned_le16(cur_network->beacon_interval,
403 &mgmt->u.probe_resp.beacon_int);
404 put_unaligned_le16(cur_network->capability,
405 &mgmt->u.probe_resp.capab_info);
407 pktlen = offsetof(struct ieee80211_mgmt, u.probe_resp.variable);
409 if (cur_network->IELength > MAX_IE_SZ)
412 memcpy(mgmt->u.probe_resp.variable, cur_network->IEs,
413 cur_network->IELength);
414 pktlen += (cur_network->IELength);
420 /* Description: Fill the reserved packets that FW will use to RSVD page. */
421 /* Now we just send 4 types packet to rsvd page. */
422 /* (1)Beacon, (2)Ps-poll, (3)Null data, (4)ProbeRsp. */
424 /* bDLFinished - false: At the first time we will send all the packets as a large packet to Hw, */
425 /* so we need to set the packet length to total lengh. */
426 /* true: At the second time, we should send the first packet (default:beacon) */
427 /* to Hw again and set the lengh in descriptor to the real beacon lengh. */
428 /* 2009.10.15 by tynli. */
429 static void SetFwRsvdPagePkt(struct rtw_adapter *padapter, bool bDLFinished)
431 struct hal_data_8723a *pHalData;
432 struct xmit_frame *pmgntframe;
433 struct pkt_attrib *pattrib;
434 struct xmit_priv *pxmitpriv;
435 struct mlme_ext_priv *pmlmeext;
436 struct mlme_ext_info *pmlmeinfo;
437 u32 BeaconLength = 0, ProbeRspLength = 0, PSPollLength;
438 u32 NullDataLength, QosNullLength, BTQosNullLength;
439 u8 *ReservedPagePacket;
440 u8 PageNum, PageNeed, TxDescLen;
443 struct rsvdpage_loc RsvdPageLoc;
445 DBG_8723A("%s\n", __func__);
447 ReservedPagePacket = kzalloc(1000, GFP_KERNEL);
448 if (ReservedPagePacket == NULL) {
449 DBG_8723A("%s: alloc ReservedPagePacket fail!\n", __func__);
453 pHalData = GET_HAL_DATA(padapter);
454 pxmitpriv = &padapter->xmitpriv;
455 pmlmeext = &padapter->mlmeextpriv;
456 pmlmeinfo = &pmlmeext->mlmext_info;
458 TxDescLen = TXDESC_SIZE;
462 BufIndex = TXDESC_OFFSET;
463 ConstructBeacon(padapter, &ReservedPagePacket[BufIndex], &BeaconLength);
465 /* When we count the first page size, we need to reserve description size for the RSVD */
466 /* packet, it will be filled in front of the packet in TXPKTBUF. */
467 PageNeed = (u8)PageNum_128(TxDescLen + BeaconLength);
468 /* To reserved 2 pages for beacon buffer. 2010.06.24. */
472 pHalData->FwRsvdPageStartOffset = PageNum;
474 BufIndex += PageNeed*128;
477 RsvdPageLoc.LocPsPoll = PageNum;
478 ConstructPSPoll(padapter, &ReservedPagePacket[BufIndex], &PSPollLength);
479 rtl8723a_fill_fake_txdesc(padapter, &ReservedPagePacket[BufIndex-TxDescLen], PSPollLength, true, false);
481 PageNeed = (u8)PageNum_128(TxDescLen + PSPollLength);
484 BufIndex += PageNeed*128;
486 /* 3 (3) null data */
487 RsvdPageLoc.LocNullData = PageNum;
488 ConstructNullFunctionData(padapter, &ReservedPagePacket[BufIndex],
490 get_my_bssid23a(&pmlmeinfo->network),
492 rtl8723a_fill_fake_txdesc(padapter,
493 &ReservedPagePacket[BufIndex-TxDescLen],
494 NullDataLength, false, false);
496 PageNeed = (u8)PageNum_128(TxDescLen + NullDataLength);
499 BufIndex += PageNeed*128;
501 /* 3 (4) probe response */
502 RsvdPageLoc.LocProbeRsp = PageNum;
505 &ReservedPagePacket[BufIndex],
507 get_my_bssid23a(&pmlmeinfo->network),
509 rtl8723a_fill_fake_txdesc(padapter, &ReservedPagePacket[BufIndex-TxDescLen], ProbeRspLength, false, false);
511 PageNeed = (u8)PageNum_128(TxDescLen + ProbeRspLength);
514 BufIndex += PageNeed*128;
516 /* 3 (5) Qos null data */
517 RsvdPageLoc.LocQosNull = PageNum;
518 ConstructNullFunctionData(
520 &ReservedPagePacket[BufIndex],
522 get_my_bssid23a(&pmlmeinfo->network),
524 rtl8723a_fill_fake_txdesc(padapter, &ReservedPagePacket[BufIndex-TxDescLen], QosNullLength, false, false);
526 PageNeed = (u8)PageNum_128(TxDescLen + QosNullLength);
529 BufIndex += PageNeed*128;
531 /* 3 (6) BT Qos null data */
532 RsvdPageLoc.LocBTQosNull = PageNum;
533 ConstructNullFunctionData(
535 &ReservedPagePacket[BufIndex],
537 get_my_bssid23a(&pmlmeinfo->network),
539 rtl8723a_fill_fake_txdesc(padapter, &ReservedPagePacket[BufIndex-TxDescLen], BTQosNullLength, false, true);
541 TotalPacketLen = BufIndex + BTQosNullLength;
543 pmgntframe = alloc_mgtxmitframe23a(pxmitpriv);
544 if (pmgntframe == NULL)
547 /* update attribute */
548 pattrib = &pmgntframe->attrib;
549 update_mgntframe_attrib23a(padapter, pattrib);
550 pattrib->qsel = 0x10;
551 pattrib->pktlen = pattrib->last_txcmdsz = TotalPacketLen - TXDESC_OFFSET;
552 memcpy(pmgntframe->buf_addr, ReservedPagePacket, TotalPacketLen);
554 rtl8723au_mgnt_xmit(padapter, pmgntframe);
556 DBG_8723A("%s: Set RSVD page location to Fw\n", __func__);
557 FillH2CCmd(padapter, RSVD_PAGE_EID, sizeof(RsvdPageLoc), (u8 *)&RsvdPageLoc);
560 kfree(ReservedPagePacket);
563 void rtl8723a_set_FwJoinBssReport_cmd(struct rtw_adapter *padapter, u8 mstatus)
565 struct joinbssrpt_parm JoinBssRptParm;
566 struct hal_data_8723a *pHalData = GET_HAL_DATA(padapter);
567 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
568 struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
570 DBG_8723A("%s mstatus(%x)\n", __func__, mstatus);
573 bool bRecover = false;
576 /* We should set AID, correct TSF, HW seq enable before set JoinBssReport to Fw in 88/92C. */
577 /* Suggested by filen. Added by tynli. */
578 rtl8723au_write16(padapter, REG_BCN_PSR_RPT,
579 0xC000|pmlmeinfo->aid);
580 /* Do not set TSF again here or vWiFi beacon DMA INT will not work. */
581 /* correct_TSF23a(padapter, pmlmeext); */
582 /* Hw sequende enable by dedault. 2010.06.23. by tynli. */
583 /* rtl8723au_write16(padapter, REG_NQOS_SEQ, ((pmlmeext->mgnt_seq+100)&0xFFF)); */
584 /* rtl8723au_write8(padapter, REG_HWSEQ_CTRL, 0xFF); */
586 /* set REG_CR bit 8 */
587 v8 = rtl8723au_read8(padapter, REG_CR+1);
588 v8 |= BIT(0); /* ENSWBCN */
589 rtl8723au_write8(padapter, REG_CR+1, v8);
591 /* Disable Hw protection for a time which revserd for Hw sending beacon. */
592 /* Fix download reserved page packet fail that access collision with the protection time. */
593 /* 2010.05.11. Added by tynli. */
594 /* SetBcnCtrlReg23a(padapter, 0, BIT(3)); */
595 /* SetBcnCtrlReg23a(padapter, BIT(4), 0); */
596 SetBcnCtrlReg23a(padapter, BIT(4), BIT(3));
598 /* Set FWHW_TXQ_CTRL 0x422[6]= 0 to tell Hw the packet is not a real beacon frame. */
599 if (pHalData->RegFwHwTxQCtrl & BIT(6))
602 /* To tell Hw the packet is not a real beacon frame. */
603 /* U1bTmp = rtl8723au_read8(padapter, REG_FWHW_TXQ_CTRL+2); */
604 rtl8723au_write8(padapter, REG_FWHW_TXQ_CTRL + 2,
605 pHalData->RegFwHwTxQCtrl & ~BIT(6));
606 pHalData->RegFwHwTxQCtrl &= ~BIT(6);
607 SetFwRsvdPagePkt(padapter, 0);
609 /* 2010.05.11. Added by tynli. */
610 SetBcnCtrlReg23a(padapter, BIT(3), BIT(4));
612 /* To make sure that if there exists an adapter which would like to send beacon. */
613 /* If exists, the origianl value of 0x422[6] will be 1, we should check this to */
614 /* prevent from setting 0x422[6] to 0 after download reserved page, or it will cause */
615 /* the beacon cannot be sent by HW. */
616 /* 2010.06.23. Added by tynli. */
618 rtl8723au_write8(padapter, REG_FWHW_TXQ_CTRL + 2,
619 pHalData->RegFwHwTxQCtrl | BIT(6));
620 pHalData->RegFwHwTxQCtrl |= BIT(6);
623 /* Clear CR[8] or beacon packet will not be send to TxBuf anymore. */
624 v8 = rtl8723au_read8(padapter, REG_CR+1);
625 v8 &= ~BIT(0); /* ~ENSWBCN */
626 rtl8723au_write8(padapter, REG_CR+1, v8);
629 JoinBssRptParm.OpMode = mstatus;
631 FillH2CCmd(padapter, JOINBSS_RPT_EID, sizeof(JoinBssRptParm), (u8 *)&JoinBssRptParm);
635 #ifdef CONFIG_8723AU_BT_COEXIST
636 static void SetFwRsvdPagePkt_BTCoex(struct rtw_adapter *padapter)
638 struct hal_data_8723a *pHalData;
639 struct xmit_frame *pmgntframe;
640 struct pkt_attrib *pattrib;
641 struct xmit_priv *pxmitpriv;
642 struct mlme_ext_priv *pmlmeext;
643 struct mlme_ext_info *pmlmeinfo;
644 u8 fakemac[6] = {0x00, 0xe0, 0x4c, 0x00, 0x00, 0x00};
645 u32 NullDataLength, BTQosNullLength;
646 u8 *ReservedPagePacket;
647 u8 PageNum, PageNeed, TxDescLen;
650 struct rsvdpage_loc RsvdPageLoc;
652 DBG_8723A("+%s\n", __func__);
654 ReservedPagePacket = kzalloc(1024, GFP_KERNEL);
655 if (ReservedPagePacket == NULL) {
656 DBG_8723A("%s: alloc ReservedPagePacket fail!\n", __func__);
660 pHalData = GET_HAL_DATA(padapter);
661 pxmitpriv = &padapter->xmitpriv;
662 pmlmeext = &padapter->mlmeextpriv;
663 pmlmeinfo = &pmlmeext->mlmext_info;
665 TxDescLen = TXDESC_SIZE;
669 BufIndex = TXDESC_OFFSET;
670 /* skip Beacon Packet */
674 pHalData->FwRsvdPageStartOffset = PageNum;
676 BufIndex += PageNeed*128;
678 /* 3 (3) null data */
679 RsvdPageLoc.LocNullData = PageNum;
680 ConstructNullFunctionData(
682 &ReservedPagePacket[BufIndex],
686 rtl8723a_fill_fake_txdesc(padapter, &ReservedPagePacket[BufIndex-TxDescLen], NullDataLength, false, false);
688 PageNeed = (u8)PageNum_128(TxDescLen + NullDataLength);
691 BufIndex += PageNeed*128;
693 /* 3 (6) BT Qos null data */
694 RsvdPageLoc.LocBTQosNull = PageNum;
695 ConstructNullFunctionData(
697 &ReservedPagePacket[BufIndex],
701 rtl8723a_fill_fake_txdesc(padapter, &ReservedPagePacket[BufIndex-TxDescLen], BTQosNullLength, false, true);
703 TotalPacketLen = BufIndex + BTQosNullLength;
705 pmgntframe = alloc_mgtxmitframe23a(pxmitpriv);
706 if (pmgntframe == NULL)
709 /* update attribute */
710 pattrib = &pmgntframe->attrib;
711 update_mgntframe_attrib23a(padapter, pattrib);
712 pattrib->qsel = 0x10;
713 pattrib->pktlen = pattrib->last_txcmdsz = TotalPacketLen - TXDESC_OFFSET;
714 memcpy(pmgntframe->buf_addr, ReservedPagePacket, TotalPacketLen);
716 rtl8723au_mgnt_xmit(padapter, pmgntframe);
718 DBG_8723A("%s: Set RSVD page location to Fw\n", __func__);
719 FillH2CCmd(padapter, RSVD_PAGE_EID, sizeof(RsvdPageLoc), (u8 *)&RsvdPageLoc);
722 kfree(ReservedPagePacket);
725 void rtl8723a_set_BTCoex_AP_mode_FwRsvdPkt_cmd(struct rtw_adapter *padapter)
727 struct hal_data_8723a *pHalData;
730 DBG_8723A("+%s\n", __func__);
732 pHalData = GET_HAL_DATA(padapter);
734 /* Set FWHW_TXQ_CTRL 0x422[6]= 0 to tell Hw the packet is not a real beacon frame. */
735 if (pHalData->RegFwHwTxQCtrl & BIT(6))
738 /* To tell Hw the packet is not a real beacon frame. */
739 pHalData->RegFwHwTxQCtrl &= ~BIT(6);
740 rtl8723au_write8(padapter, REG_FWHW_TXQ_CTRL + 2,
741 pHalData->RegFwHwTxQCtrl);
742 SetFwRsvdPagePkt_BTCoex(padapter);
744 /* To make sure that if there exists an adapter which would like to send beacon. */
745 /* If exists, the origianl value of 0x422[6] will be 1, we should check this to */
746 /* prevent from setting 0x422[6] to 0 after download reserved page, or it will cause */
747 /* the beacon cannot be sent by HW. */
748 /* 2010.06.23. Added by tynli. */
750 pHalData->RegFwHwTxQCtrl |= BIT(6);
751 rtl8723au_write8(padapter, REG_FWHW_TXQ_CTRL + 2,
752 pHalData->RegFwHwTxQCtrl);