1416 lines
40 KiB
C
1416 lines
40 KiB
C
/******************************************************************************
|
|
*
|
|
* Copyright(c) 2015 - 2016 Realtek Corporation. All rights reserved.
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify it
|
|
* under the terms of version 2 of the GNU General Public License as
|
|
* published by the Free Software Foundation.
|
|
*
|
|
* This program is distributed in the hope that it will be useful, but WITHOUT
|
|
* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
|
|
* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
|
|
* more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License along with
|
|
* this program; if not, write to the Free Software Foundation, Inc.,
|
|
* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
|
|
*
|
|
*
|
|
******************************************************************************/
|
|
#define _RTL8822B_CMD_C_
|
|
|
|
#include <hal_data.h> /* HAL_DATA_TYPE */
|
|
#include "../hal_halmac.h" /* HRTW_HALMAC_H2C_MAX_SIZE, CMD_ID_RSVD_PAGE and etc. */
|
|
#include "rtl8822b.h"
|
|
|
|
/*
|
|
* Below functions are for C2H
|
|
*/
|
|
/*****************************************
|
|
* H2C Msg format :
|
|
*| 31 - 8 |7-5 | 4 - 0 |
|
|
*| h2c_msg |Class |CMD_ID |
|
|
*| 31-0 |
|
|
*| Ext msg |
|
|
*
|
|
******************************************/
|
|
s32 rtl8822b_fillh2ccmd(PADAPTER adapter, u8 id, u32 buf_len, u8 *pbuf)
|
|
{
|
|
u8 h2c[RTW_HALMAC_H2C_MAX_SIZE] = {0};
|
|
#ifdef CONFIG_RTW_DEBUG
|
|
u8 msg[(RTW_HALMAC_H2C_MAX_SIZE - 1) * 5 + 1] = {0};
|
|
u8 *msg_p;
|
|
u32 msg_size, i, n;
|
|
#endif /* CONFIG_RTW_DEBUG */
|
|
int err;
|
|
s32 ret = _FAIL;
|
|
|
|
|
|
if (!pbuf)
|
|
goto exit;
|
|
|
|
if (buf_len > (RTW_HALMAC_H2C_MAX_SIZE - 1))
|
|
goto exit;
|
|
|
|
if (rtw_is_surprise_removed(adapter))
|
|
goto exit;
|
|
|
|
#ifdef CONFIG_RTW_DEBUG
|
|
msg_p = msg;
|
|
msg_size = (RTW_HALMAC_H2C_MAX_SIZE - 1) * 5 + 1;
|
|
for (i = 0; i < buf_len; i++) {
|
|
n = rtw_sprintf(msg_p, msg_size, " 0x%02x", pbuf[i]);
|
|
msg_p += n;
|
|
msg_size -= n;
|
|
if (msg_size == 0)
|
|
break;
|
|
}
|
|
RTW_DBG(FUNC_ADPT_FMT ": id=0x%02x buf=%s\n",
|
|
FUNC_ADPT_ARG(adapter), id, msg);
|
|
#endif /* CONFIG_RTW_DEBUG */
|
|
|
|
h2c[0] = id;
|
|
_rtw_memcpy(h2c + 1, pbuf, buf_len);
|
|
|
|
err = rtw_halmac_send_h2c(adapter_to_dvobj(adapter), h2c);
|
|
if (!err)
|
|
ret = _SUCCESS;
|
|
|
|
exit:
|
|
|
|
return ret;
|
|
}
|
|
|
|
static void rtl8822b_set_FwRsvdPage_cmd(PADAPTER adapter, PRSVDPAGE_LOC rsvdpageloc)
|
|
{
|
|
u8 h2c[RTW_HALMAC_H2C_MAX_SIZE] = {0};
|
|
|
|
|
|
RTW_INFO(FUNC_ADPT_FMT ": ProbeRsp=%d PsPoll=%d Null=%d QoSNull=%d BTNull=%d\n",
|
|
FUNC_ADPT_ARG(adapter),
|
|
rsvdpageloc->LocProbeRsp, rsvdpageloc->LocPsPoll,
|
|
rsvdpageloc->LocNullData, rsvdpageloc->LocQosNull,
|
|
rsvdpageloc->LocBTQosNull);
|
|
|
|
RSVD_PAGE_SET_CMD_ID(h2c, CMD_ID_RSVD_PAGE);
|
|
RSVD_PAGE_SET_CLASS(h2c, CLASS_RSVD_PAGE);
|
|
RSVD_PAGE_SET_LOC_PROBE_RSP(h2c, rsvdpageloc->LocProbeRsp);
|
|
RSVD_PAGE_SET_LOC_PS_POLL(h2c, rsvdpageloc->LocPsPoll);
|
|
RSVD_PAGE_SET_LOC_NULL_DATA(h2c, rsvdpageloc->LocNullData);
|
|
RSVD_PAGE_SET_LOC_QOS_NULL(h2c, rsvdpageloc->LocQosNull);
|
|
RSVD_PAGE_SET_LOC_BT_QOS_NULL(h2c, rsvdpageloc->LocBTQosNull);
|
|
|
|
RTW_DBG_DUMP("H2C-RsvdPage Parm:", h2c, RTW_HALMAC_H2C_MAX_SIZE);
|
|
rtw_halmac_send_h2c(adapter_to_dvobj(adapter), h2c);
|
|
}
|
|
|
|
static void rtl8822b_set_FwAoacRsvdPage_cmd(PADAPTER adapter, PRSVDPAGE_LOC rsvdpageloc)
|
|
{
|
|
#ifdef CONFIG_WOWLAN
|
|
struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter);
|
|
struct mlme_priv *pmlmepriv = &adapter->mlmepriv;
|
|
u8 res = 0, count = 0;
|
|
u8 h2c[RTW_HALMAC_H2C_MAX_SIZE] = {0};
|
|
|
|
|
|
RTW_INFO(FUNC_ADPT_FMT ": RWC=%d ArpRsp=%d NbrAdv=%d GtkRsp=%d GtkInfo=%d ProbeReq=%d NetworkList=%d\n",
|
|
FUNC_ADPT_ARG(adapter),
|
|
rsvdpageloc->LocRemoteCtrlInfo, rsvdpageloc->LocArpRsp,
|
|
rsvdpageloc->LocNbrAdv, rsvdpageloc->LocGTKRsp,
|
|
rsvdpageloc->LocGTKInfo, rsvdpageloc->LocProbeReq,
|
|
rsvdpageloc->LocNetList);
|
|
|
|
if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) {
|
|
AOAC_RSVD_PAGE_SET_CMD_ID(h2c, CMD_ID_AOAC_RSVD_PAGE);
|
|
AOAC_RSVD_PAGE_SET_CLASS(h2c, CLASS_AOAC_RSVD_PAGE);
|
|
AOAC_RSVD_PAGE_SET_LOC_REMOTE_CTRL_INFO(h2c, rsvdpageloc->LocRemoteCtrlInfo);
|
|
AOAC_RSVD_PAGE_SET_LOC_ARP_RESPONSE(h2c, rsvdpageloc->LocArpRsp);
|
|
AOAC_RSVD_PAGE_SET_LOC_GTK_RSP(h2c, rsvdpageloc->LocGTKRsp);
|
|
AOAC_RSVD_PAGE_SET_LOC_GTK_INFO(h2c, rsvdpageloc->LocGTKInfo);
|
|
#ifdef CONFIG_GTK_OL
|
|
AOAC_RSVD_PAGE_SET_LOC_GTK_EXT_MEM(h2c, rsvdpageloc->LocGTKEXTMEM);
|
|
#endif /* CONFIG_GTK_OL */
|
|
RTW_DBG_DUMP("H2C-AoacRsvdPage Parm:", h2c, RTW_HALMAC_H2C_MAX_SIZE);
|
|
rtw_halmac_send_h2c(adapter_to_dvobj(adapter), h2c);
|
|
} else {
|
|
#ifdef CONFIG_PNO_SUPPORT
|
|
if (!pwrpriv->pno_in_resume) {
|
|
RTW_INFO("%s: NLO_INFO=%d\n", __FUNCTION__, rsvdpageloc->LocPNOInfo);
|
|
AOAC_RSVD_PAGE3_SET_CMD_ID(h2c, CMD_ID_AOAC_RSVD_PAGE3);
|
|
AOAC_RSVD_PAGE3_SET_CLASS(h2c, CLASS_AOAC_RSVD_PAGE3);
|
|
AOAC_RSVD_PAGE3_SET_LOC_NLO_INFO(h2c, rsvdpageloc->LocPNOInfo);
|
|
RTW_DBG_DUMP("H2C-AoacRsvdPage3 Parm:", h2c, RTW_HALMAC_H2C_MAX_SIZE);
|
|
rtw_halmac_send_h2c(adapter_to_dvobj(adapter), h2c);
|
|
rtw_msleep_os(10);
|
|
}
|
|
#endif /* CONFIG_PNO_SUPPORT */
|
|
}
|
|
#endif /* CONFIG_WOWLAN */
|
|
}
|
|
|
|
void rtl8822b_set_FwMediaStatusRpt_cmd(PADAPTER adapter, u8 mstatus, u8 macid)
|
|
{
|
|
u8 h2c[RTW_HALMAC_H2C_MAX_SIZE] = {0};
|
|
u8 macid_end = 0;
|
|
|
|
RTW_INFO(FUNC_ADPT_FMT ": mstatus=%d macid=%d\n",
|
|
FUNC_ADPT_ARG(adapter), mstatus, macid);
|
|
|
|
MEDIA_STATUS_RPT_SET_CMD_ID(h2c, CMD_ID_MEDIA_STATUS_RPT);
|
|
MEDIA_STATUS_RPT_SET_CLASS(h2c, CLASS_MEDIA_STATUS_RPT);
|
|
MEDIA_STATUS_RPT_SET_OP_MODE(h2c, mstatus);
|
|
MEDIA_STATUS_RPT_SET_MACID_IN(h2c, 0);
|
|
MEDIA_STATUS_RPT_SET_MACID(h2c, macid);
|
|
MEDIA_STATUS_RPT_SET_MACID_END(h2c, macid_end);
|
|
|
|
RTW_DBG_DUMP("H2C-MediaStatusRpt Parm:", h2c, RTW_HALMAC_H2C_MAX_SIZE);
|
|
rtw_halmac_send_h2c(adapter_to_dvobj(adapter), h2c);
|
|
}
|
|
|
|
static void rtl8822b_set_FwKeepAlive_cmd(PADAPTER adapter, u8 benable, u8 pkt_type)
|
|
{
|
|
u8 h2c[RTW_HALMAC_H2C_MAX_SIZE] = {0};
|
|
u8 adopt = 1;
|
|
#ifdef CONFIG_PLATFORM_INTEL_BYT
|
|
u8 check_period = 10;
|
|
#else
|
|
u8 check_period = 5;
|
|
#endif
|
|
|
|
|
|
RTW_INFO(FUNC_ADPT_FMT ": benable=%d\n", FUNC_ADPT_ARG(adapter), benable);
|
|
|
|
KEEP_ALIVE_SET_CMD_ID(h2c, CMD_ID_KEEP_ALIVE);
|
|
KEEP_ALIVE_SET_CLASS(h2c, CLASS_KEEP_ALIVE);
|
|
KEEP_ALIVE_SET_ENABLE(h2c, benable);
|
|
KEEP_ALIVE_SET_ADOPT_USER_SETTING(h2c, adopt);
|
|
KEEP_ALIVE_SET_PKT_TYPE(h2c, pkt_type);
|
|
KEEP_ALIVE_SET_KEEP_ALIVE_CHECK_PERIOD(h2c, check_period);
|
|
|
|
RTW_DBG_DUMP("H2C-KeepAlive Parm:", h2c, RTW_HALMAC_H2C_MAX_SIZE);
|
|
rtw_halmac_send_h2c(adapter_to_dvobj(adapter), h2c);
|
|
}
|
|
|
|
static void rtl8822b_set_FwDisconDecision_cmd(PADAPTER adapter, u8 benable)
|
|
{
|
|
u8 h2c[RTW_HALMAC_H2C_MAX_SIZE] = {0};
|
|
u8 adopt = 1, check_period = 10, trypkt_num = 0;
|
|
|
|
|
|
RTW_INFO(FUNC_ADPT_FMT ": benable=%d\n",
|
|
FUNC_ADPT_ARG(adapter), benable);
|
|
|
|
DISCONNECT_DECISION_SET_CMD_ID(h2c, CMD_ID_DISCONNECT_DECISION);
|
|
DISCONNECT_DECISION_SET_CLASS(h2c, CLASS_DISCONNECT_DECISION);
|
|
DISCONNECT_DECISION_SET_ENABLE(h2c, benable);
|
|
DISCONNECT_DECISION_SET_ADOPT_USER_SETTING(h2c, adopt);
|
|
DISCONNECT_DECISION_SET_DISCON_DECISION_CHECK_PERIOD(h2c, check_period);
|
|
DISCONNECT_DECISION_SET_TRY_PKT_NUM(h2c, trypkt_num);
|
|
|
|
RTW_DBG_DUMP("H2C-DisconDecision Parm:", h2c, RTW_HALMAC_H2C_MAX_SIZE);
|
|
rtw_halmac_send_h2c(adapter_to_dvobj(adapter), h2c);
|
|
}
|
|
|
|
static u8 get_ra_vht_en(u32 wirelessMode, u32 bitmap)
|
|
{
|
|
u8 ret = 0;
|
|
|
|
if (wirelessMode == WIRELESS_11_24AC) {
|
|
if (bitmap & 0xfff00000) /* 2SS */
|
|
ret = 3;
|
|
else /* 1SS */
|
|
ret = 2;
|
|
} else if (wirelessMode == WIRELESS_11_5AC)
|
|
ret = 1;
|
|
|
|
return ret;
|
|
}
|
|
|
|
static u8 get_ra_ldpc(struct sta_info *psta)
|
|
{
|
|
u8 en_ldpc = 0;
|
|
|
|
if (psta != NULL) {
|
|
if (psta->mac_id == 1)
|
|
en_ldpc = 0;
|
|
else {
|
|
#ifdef CONFIG_80211AC_VHT
|
|
if (IsSupportedVHT(psta->wireless_mode)) {
|
|
if (TEST_FLAG(psta->vhtpriv.ldpc_cap, LDPC_VHT_CAP_TX))
|
|
en_ldpc = 1;
|
|
else
|
|
en_ldpc = 0;
|
|
} else if (IsSupportedHT(psta->wireless_mode)) {
|
|
if (TEST_FLAG(psta->htpriv.ldpc_cap, LDPC_HT_CAP_TX))
|
|
en_ldpc = 1;
|
|
else
|
|
en_ldpc = 0;
|
|
} else
|
|
#endif
|
|
en_ldpc = 0;
|
|
}
|
|
}
|
|
|
|
return en_ldpc;
|
|
}
|
|
|
|
|
|
/*
|
|
* arg[0] = macid
|
|
* arg[1] = raid
|
|
* arg[2] = shortGIrate
|
|
* arg[3] = init_rate
|
|
*/
|
|
void rtl8822b_set_FwMacIdConfig_cmd(PADAPTER adapter, u64 mask, u8 *arg)
|
|
{
|
|
HAL_DATA_TYPE *hal = GET_HAL_DATA(adapter);
|
|
struct macid_ctl_t *macid_ctl = &adapter->dvobj->macid_ctl;
|
|
struct sta_info *psta = NULL;
|
|
u8 mac_id, init_rate, raid, bw, sgi = _FALSE;
|
|
u8 h2c[RTW_HALMAC_H2C_MAX_SIZE] = {0};
|
|
|
|
|
|
if (hal->fw_ractrl == _FALSE) {
|
|
RTW_INFO(FUNC_ADPT_FMT" fw ractrl = _FALSE\n",
|
|
FUNC_ADPT_ARG(adapter));
|
|
return;
|
|
}
|
|
|
|
mac_id = arg[0];
|
|
raid = arg[1];
|
|
sgi = arg[2];
|
|
init_rate = arg[3];
|
|
|
|
if (mac_id < macid_ctl->num)
|
|
psta = macid_ctl->sta[mac_id];
|
|
|
|
if (!psta) {
|
|
RTW_INFO(FUNC_ADPT_FMT" macid:%u, sta is NULL\n",
|
|
FUNC_ADPT_ARG(adapter), mac_id);
|
|
return;
|
|
}
|
|
|
|
bw = psta->bw_mode;
|
|
|
|
RTW_INFO(FUNC_ADPT_FMT ": mac_id=%d raid=0x%x bw=%d mask=0x%016llx\n",
|
|
FUNC_ADPT_ARG(adapter), mac_id, raid, bw, mask);
|
|
|
|
|
|
MACID_CFG_SET_CMD_ID(h2c, CMD_ID_MACID_CFG);
|
|
MACID_CFG_SET_CLASS(h2c, CLASS_MACID_CFG);
|
|
|
|
/* common for h2c cmd 0x40 & 0x46 */
|
|
MACID_CFG_SET_MAC_ID(h2c, mac_id);
|
|
MACID_CFG_SET_RATE_ID(h2c, raid);
|
|
MACID_CFG_SET_SGI(h2c, (sgi) ? 1 : 0);
|
|
MACID_CFG_SET_BW(h2c, bw);
|
|
MACID_CFG_SET_LDPC_CAP(h2c, get_ra_ldpc(psta));
|
|
MACID_CFG_SET_WHT_EN(h2c, get_ra_vht_en(psta->wireless_mode, mask));
|
|
|
|
|
|
/* DisableTXPowerTraining */
|
|
if (hal->bDisableTXPowerTraining) {
|
|
MACID_CFG_SET_DISPT(h2c, 1);
|
|
RTW_INFO("%s: Disable PWT by driver\n", __FUNCTION__);
|
|
} else {
|
|
PDM_ODM_T pDM_OutSrc = &hal->odmpriv;
|
|
|
|
if (pDM_OutSrc->bDisablePowerTraining) {
|
|
MACID_CFG_SET_DISPT(h2c, 1);
|
|
RTW_INFO("%s: Disable PWT by DM\n", __FUNCTION__);
|
|
}
|
|
}
|
|
|
|
MACID_CFG_SET_RATE_MASK7_0(h2c, (u8)(mask & 0x000000ff));
|
|
MACID_CFG_SET_RATE_MASK15_8(h2c, (u8)((mask & 0x0000ff00) >> 8));
|
|
MACID_CFG_SET_RATE_MASK23_16(h2c, (u8)((mask & 0x00ff0000) >> 16));
|
|
MACID_CFG_SET_RATE_MASK31_24(h2c, (u8)((mask & 0xff000000) >> 24));
|
|
|
|
RTW_INFO("%s, mask=0x%016llx, mac_id=0x%x, raid=0x%x, shortGIrate=%x, power training=%02x\n"
|
|
, __FUNCTION__, mask, mac_id, raid, sgi, h2c[2] & BIT(6));
|
|
|
|
RTW_DBG_DUMP("H2C-MACIDConfig Parm:", h2c, RTW_HALMAC_H2C_MAX_SIZE);
|
|
rtw_halmac_send_h2c(adapter_to_dvobj(adapter), h2c);
|
|
|
|
/* update initial rate */
|
|
if (sgi)
|
|
init_rate |= BIT(7);
|
|
|
|
hal->INIDATA_RATE[mac_id] = init_rate;
|
|
}
|
|
|
|
void rtl8822b_set_FwRssiSetting_cmd(PADAPTER adapter, u8 *param)
|
|
{
|
|
u8 h2c[RTW_HALMAC_H2C_MAX_SIZE] = {0};
|
|
u8 mac_id = *param;
|
|
u8 rssi = *(param + 2);
|
|
u8 ra_info = 0;
|
|
|
|
|
|
RTW_INFO(FUNC_ADPT_FMT ": mac_id=%d rssi=%d param=%.2x-%.2x-%.2x\n",
|
|
FUNC_ADPT_ARG(adapter),
|
|
mac_id, rssi, *param, *(param + 1), *(param + 2));
|
|
|
|
RSSI_SETTING_SET_CMD_ID(h2c, CMD_ID_RSSI_SETTING);
|
|
RSSI_SETTING_SET_CLASS(h2c, CLASS_RSSI_SETTING);
|
|
RSSI_SETTING_SET_MAC_ID(h2c, mac_id);
|
|
RSSI_SETTING_SET_RSSI(h2c, rssi);
|
|
RSSI_SETTING_SET_RA_INFO(h2c, ra_info);
|
|
|
|
RTW_DBG_DUMP("H2C-RssiSetting Parm:", h2c, RTW_HALMAC_H2C_MAX_SIZE);
|
|
rtw_halmac_send_h2c(adapter_to_dvobj(adapter), h2c);
|
|
}
|
|
|
|
void rtl8822b_set_FwAPReqRPT_cmd(PADAPTER adapter, u32 need_ack)
|
|
{
|
|
u8 h2c[RTW_HALMAC_H2C_MAX_SIZE] = {0};
|
|
u8 macid1 = 1, macid2 = 0;
|
|
|
|
|
|
RTW_INFO(FUNC_ADPT_FMT ": need_ack = %d\n",
|
|
FUNC_ADPT_ARG(adapter), need_ack);
|
|
|
|
AP_REQ_TXRPT_SET_CMD_ID(h2c, CMD_ID_AP_REQ_TXRPT);
|
|
AP_REQ_TXRPT_SET_CLASS(h2c, CLASS_AP_REQ_TXRPT);
|
|
AP_REQ_TXRPT_SET_STA1_MACID(h2c, macid1);
|
|
AP_REQ_TXRPT_SET_STA2_MACID(h2c, macid2);
|
|
|
|
RTW_DBG_DUMP("H2C-ApReqRpt Parm:", h2c, RTW_HALMAC_H2C_MAX_SIZE);
|
|
rtw_halmac_send_h2c(adapter_to_dvobj(adapter), h2c);
|
|
}
|
|
|
|
void rtl8822b_set_FwPwrMode_cmd(PADAPTER adapter, u8 psmode)
|
|
{
|
|
int i;
|
|
u8 smart_ps = 0;
|
|
struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter);
|
|
struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv;
|
|
u8 h2c[RTW_HALMAC_H2C_MAX_SIZE] = {0};
|
|
u8 PowerState = 0, awake_intvl = 1, byte5 = 0, rlbm = 0;
|
|
#ifdef CONFIG_P2P
|
|
struct wifidirect_info *wdinfo = &adapter->wdinfo;
|
|
#endif /* CONFIG_P2P */
|
|
|
|
|
|
if (pwrpriv->dtim > 0)
|
|
RTW_INFO(FUNC_ADPT_FMT ": FW LPS mode = %d, SmartPS=%d, dtim=%d\n",
|
|
FUNC_ADPT_ARG(adapter), psmode, pwrpriv->smart_ps, pwrpriv->dtim);
|
|
else
|
|
RTW_INFO(FUNC_ADPT_FMT ": FW LPS mode = %d, SmartPS=%d\n",
|
|
FUNC_ADPT_ARG(adapter), psmode, pwrpriv->smart_ps);
|
|
|
|
if (psmode == PS_MODE_MIN) {
|
|
rlbm = 0;
|
|
awake_intvl = 2;
|
|
smart_ps = pwrpriv->smart_ps;
|
|
} else if (psmode == PS_MODE_MAX) {
|
|
rlbm = 1;
|
|
awake_intvl = 2;
|
|
smart_ps = pwrpriv->smart_ps;
|
|
} else if (psmode == PS_MODE_DTIM) {
|
|
/* For WOWLAN LPS, DTIM = (awake_intvl - 1) */
|
|
if (pwrpriv->dtim > 0 && pwrpriv->dtim < 16)
|
|
/* DTIM = (awake_intvl - 1) */
|
|
awake_intvl = pwrpriv->dtim + 1;
|
|
else
|
|
/* DTIM = 3 */
|
|
awake_intvl = 4;
|
|
|
|
rlbm = 2;
|
|
smart_ps = pwrpriv->smart_ps;
|
|
} else {
|
|
rlbm = 2;
|
|
awake_intvl = 4;
|
|
smart_ps = pwrpriv->smart_ps;
|
|
}
|
|
|
|
#ifdef CONFIG_P2P
|
|
if (!rtw_p2p_chk_state(wdinfo, P2P_STATE_NONE)) {
|
|
awake_intvl = 2;
|
|
rlbm = 1;
|
|
}
|
|
#endif /* CONFIG_P2P */
|
|
|
|
if (adapter->registrypriv.wifi_spec == 1) {
|
|
awake_intvl = 2;
|
|
rlbm = 1;
|
|
}
|
|
|
|
if (psmode > 0) {
|
|
#ifdef CONFIG_BT_COEXIST
|
|
if (rtw_btcoex_IsBtControlLps(adapter) == _TRUE) {
|
|
PowerState = rtw_btcoex_RpwmVal(adapter);
|
|
byte5 = rtw_btcoex_LpsVal(adapter);
|
|
|
|
if ((rlbm == 2) && (byte5 & BIT(4))) {
|
|
/*
|
|
* Keep awake interval to 1 to prevent from
|
|
* decreasing coex performance
|
|
*/
|
|
awake_intvl = 2;
|
|
rlbm = 2;
|
|
}
|
|
} else
|
|
#endif /* CONFIG_BT_COEXIST */
|
|
{
|
|
PowerState = 0x00; /* AllON(0x0C), RFON(0x04), RFOFF(0x00) */
|
|
byte5 = 0x40;
|
|
}
|
|
} else {
|
|
PowerState = 0x0C; /* AllON(0x0C), RFON(0x04), RFOFF(0x00) */
|
|
byte5 = 0x40;
|
|
}
|
|
|
|
SET_PWR_MODE_SET_CMD_ID(h2c, CMD_ID_SET_PWR_MODE);
|
|
SET_PWR_MODE_SET_CLASS(h2c, CLASS_SET_PWR_MODE);
|
|
SET_PWR_MODE_SET_MODE(h2c, (psmode > 0) ? 1 : 0);
|
|
SET_PWR_MODE_SET_SMART_PS(h2c, smart_ps);
|
|
SET_PWR_MODE_SET_RLBM(h2c, rlbm);
|
|
SET_PWR_MODE_SET_AWAKE_INTERVAL(h2c, awake_intvl);
|
|
SET_PWR_MODE_SET_B_ALL_QUEUE_UAPSD(h2c, adapter->registrypriv.uapsd_enable);
|
|
SET_PWR_MODE_SET_PWR_STATE(h2c, PowerState);
|
|
SET_PWR_MODE_SET_PORT_ID(h2c, get_hw_port(adapter));
|
|
|
|
if (byte5 & BIT(0))
|
|
SET_PWR_MODE_SET_LOW_POWER_RX_BCN(h2c, 1);
|
|
if (byte5 & BIT(1))
|
|
SET_PWR_MODE_SET_ANT_AUTO_SWITCH(h2c, 1);
|
|
if (byte5 & BIT(2))
|
|
SET_PWR_MODE_SET_PS_ALLOW_BT_HIGH_PRIORITY(h2c, 1);
|
|
if (byte5 & BIT(3))
|
|
SET_PWR_MODE_SET_PROTECT_BCN(h2c, 1);
|
|
if (byte5 & BIT(4))
|
|
SET_PWR_MODE_SET_SILENCE_PERIOD(h2c, 1);
|
|
if (byte5 & BIT(5))
|
|
SET_PWR_MODE_SET_FAST_BT_CONNECT(h2c, 1);
|
|
if (byte5 & BIT(6))
|
|
SET_PWR_MODE_SET_TWO_ANTENNA_EN(h2c, 1);
|
|
|
|
#ifdef CONFIG_LPS_LCLK
|
|
if (psmode != PS_MODE_ACTIVE) {
|
|
if ((pmlmeext->adaptive_tsf_done == _FALSE)
|
|
&& (pmlmeext->bcn_cnt > 0)) {
|
|
u8 ratio_20_delay, ratio_80_delay;
|
|
|
|
/*
|
|
* byte 6 for adaptive_early_32k
|
|
* [0:3] = DrvBcnEarly (ms), [4:7] = DrvBcnTimeOut (ms)
|
|
* 20% for DrvBcnEarly, 80% for DrvBcnTimeOut
|
|
*/
|
|
ratio_20_delay = 0;
|
|
ratio_80_delay = 0;
|
|
pmlmeext->DrvBcnEarly = 0xff;
|
|
pmlmeext->DrvBcnTimeOut = 0xff;
|
|
|
|
for (i = 0; i < 9; i++) {
|
|
pmlmeext->bcn_delay_ratio[i] = (pmlmeext->bcn_delay_cnt[i] * 100) / pmlmeext->bcn_cnt;
|
|
|
|
ratio_20_delay += pmlmeext->bcn_delay_ratio[i];
|
|
ratio_80_delay += pmlmeext->bcn_delay_ratio[i];
|
|
|
|
if (ratio_20_delay > 20 && pmlmeext->DrvBcnEarly == 0xff)
|
|
pmlmeext->DrvBcnEarly = i;
|
|
|
|
if (ratio_80_delay > 80 && pmlmeext->DrvBcnTimeOut == 0xff)
|
|
pmlmeext->DrvBcnTimeOut = i;
|
|
|
|
/* reset adaptive_early_32k cnt */
|
|
pmlmeext->bcn_delay_cnt[i] = 0;
|
|
pmlmeext->bcn_delay_ratio[i] = 0;
|
|
}
|
|
|
|
pmlmeext->bcn_cnt = 0;
|
|
pmlmeext->adaptive_tsf_done = _TRUE;
|
|
}
|
|
}
|
|
#endif /* CONFIG_LPS_LCLK */
|
|
|
|
#ifdef CONFIG_BT_COEXIST
|
|
rtw_btcoex_RecordPwrMode(adapter, h2c + 1, RTW_HALMAC_H2C_MAX_SIZE - 1);
|
|
#endif /* CONFIG_BT_COEXIST */
|
|
|
|
RTW_DBG_DUMP("H2C-PwrMode Parm:", h2c, RTW_HALMAC_H2C_MAX_SIZE);
|
|
rtw_halmac_send_h2c(adapter_to_dvobj(adapter), h2c);
|
|
}
|
|
|
|
void rtl8822b_set_FwPwrModeInIPS_cmd(PADAPTER adapter, u8 cmd_param)
|
|
{
|
|
}
|
|
|
|
static s32 rtl8822b_set_FwLowPwrLps_cmd(PADAPTER adapter, u8 enable)
|
|
{
|
|
return _FALSE;
|
|
}
|
|
|
|
#ifdef CONFIG_BT_COEXIST
|
|
static void ConstructBeacon(PADAPTER adapter, u8 *pframe, u32 *pLength)
|
|
{
|
|
struct rtw_ieee80211_hdr *pwlanhdr;
|
|
u16 *fctrl;
|
|
u32 rate_len, pktlen;
|
|
struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv;
|
|
struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
|
|
WLAN_BSSID_EX *cur_network = &pmlmeinfo->network;
|
|
u8 bc_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff};
|
|
|
|
|
|
pwlanhdr = (struct rtw_ieee80211_hdr *)pframe;
|
|
|
|
fctrl = &(pwlanhdr->frame_ctl);
|
|
*(fctrl) = 0;
|
|
|
|
_rtw_memcpy(pwlanhdr->addr1, bc_addr, ETH_ALEN);
|
|
_rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(adapter), ETH_ALEN);
|
|
_rtw_memcpy(pwlanhdr->addr3, get_my_bssid(cur_network), ETH_ALEN);
|
|
|
|
SetSeqNum(pwlanhdr, 0);
|
|
SetFrameSubType(pframe, WIFI_BEACON);
|
|
|
|
pframe += sizeof(struct rtw_ieee80211_hdr_3addr);
|
|
pktlen = sizeof(struct rtw_ieee80211_hdr_3addr);
|
|
|
|
/* timestamp will be inserted by hardware */
|
|
pframe += 8;
|
|
pktlen += 8;
|
|
|
|
/* beacon interval: 2 bytes */
|
|
_rtw_memcpy(pframe, (u8 *)rtw_get_beacon_interval_from_ie(cur_network->IEs), 2);
|
|
|
|
pframe += 2;
|
|
pktlen += 2;
|
|
|
|
/* capability info: 2 bytes */
|
|
_rtw_memcpy(pframe, (u8 *)rtw_get_capability_from_ie(cur_network->IEs), 2);
|
|
|
|
pframe += 2;
|
|
pktlen += 2;
|
|
|
|
if ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) {
|
|
pktlen += cur_network->IELength - sizeof(NDIS_802_11_FIXED_IEs);
|
|
_rtw_memcpy(pframe, cur_network->IEs + sizeof(NDIS_802_11_FIXED_IEs), pktlen);
|
|
|
|
goto _ConstructBeacon;
|
|
}
|
|
|
|
/* below for ad-hoc mode */
|
|
|
|
/* SSID */
|
|
pframe = rtw_set_ie(pframe, _SSID_IE_, cur_network->Ssid.SsidLength, cur_network->Ssid.Ssid, &pktlen);
|
|
|
|
/* supported rates... */
|
|
rate_len = rtw_get_rateset_len(cur_network->SupportedRates);
|
|
pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_, ((rate_len > 8) ? 8 : rate_len), cur_network->SupportedRates, &pktlen);
|
|
|
|
/* DS parameter set */
|
|
pframe = rtw_set_ie(pframe, _DSSET_IE_, 1, (unsigned char *)&(cur_network->Configuration.DSConfig), &pktlen);
|
|
|
|
if ((pmlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE) {
|
|
u32 ATIMWindow;
|
|
/* IBSS Parameter Set... */
|
|
ATIMWindow = 0;
|
|
pframe = rtw_set_ie(pframe, _IBSS_PARA_IE_, 2, (unsigned char *)(&ATIMWindow), &pktlen);
|
|
}
|
|
|
|
/* todo: ERP IE */
|
|
|
|
/* EXTERNDED SUPPORTED RATE */
|
|
if (rate_len > 8)
|
|
pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_, (rate_len - 8), (cur_network->SupportedRates + 8), &pktlen);
|
|
|
|
|
|
/* todo:HT for adhoc */
|
|
|
|
_ConstructBeacon:
|
|
|
|
if ((pktlen + TXDESC_SIZE) > 512) {
|
|
RTW_INFO("beacon frame too large\n");
|
|
return;
|
|
}
|
|
|
|
*pLength = pktlen;
|
|
}
|
|
|
|
static void ConstructPSPoll(PADAPTER adapter, u8 *pframe, u32 *pLength)
|
|
{
|
|
struct rtw_ieee80211_hdr *pwlanhdr;
|
|
u16 *fctrl;
|
|
u32 pktlen;
|
|
struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv;
|
|
struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
|
|
|
|
|
|
pwlanhdr = (struct rtw_ieee80211_hdr *)pframe;
|
|
|
|
/* Frame control. */
|
|
fctrl = &(pwlanhdr->frame_ctl);
|
|
*(fctrl) = 0;
|
|
SetPwrMgt(fctrl);
|
|
SetFrameSubType(pframe, WIFI_PSPOLL);
|
|
|
|
/* AID. */
|
|
SetDuration(pframe, (pmlmeinfo->aid | 0xc000));
|
|
|
|
/* BSSID. */
|
|
_rtw_memcpy(pwlanhdr->addr1, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN);
|
|
|
|
/* TA. */
|
|
_rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(adapter), ETH_ALEN);
|
|
|
|
*pLength = 16;
|
|
}
|
|
|
|
static void ConstructNullFunctionData(
|
|
PADAPTER adapter,
|
|
u8 *pframe,
|
|
u32 *pLength,
|
|
u8 *StaAddr,
|
|
u8 bQoS,
|
|
u8 AC,
|
|
u8 bEosp,
|
|
u8 bForcePowerSave)
|
|
{
|
|
struct rtw_ieee80211_hdr *pwlanhdr;
|
|
u16 *fctrl;
|
|
u32 pktlen;
|
|
struct mlme_priv *pmlmepriv = &adapter->mlmepriv;
|
|
struct wlan_network *cur_network = &pmlmepriv->cur_network;
|
|
struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv;
|
|
struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
|
|
|
|
|
|
pwlanhdr = (struct rtw_ieee80211_hdr *)pframe;
|
|
|
|
fctrl = &pwlanhdr->frame_ctl;
|
|
*(fctrl) = 0;
|
|
if (bForcePowerSave)
|
|
SetPwrMgt(fctrl);
|
|
|
|
switch (cur_network->network.InfrastructureMode) {
|
|
case Ndis802_11Infrastructure:
|
|
SetToDs(fctrl);
|
|
_rtw_memcpy(pwlanhdr->addr1, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN);
|
|
_rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(adapter), ETH_ALEN);
|
|
_rtw_memcpy(pwlanhdr->addr3, StaAddr, ETH_ALEN);
|
|
break;
|
|
case Ndis802_11APMode:
|
|
SetFrDs(fctrl);
|
|
_rtw_memcpy(pwlanhdr->addr1, StaAddr, ETH_ALEN);
|
|
_rtw_memcpy(pwlanhdr->addr2, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN);
|
|
_rtw_memcpy(pwlanhdr->addr3, adapter_mac_addr(adapter), ETH_ALEN);
|
|
break;
|
|
case Ndis802_11IBSS:
|
|
default:
|
|
_rtw_memcpy(pwlanhdr->addr1, StaAddr, ETH_ALEN);
|
|
_rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(adapter), ETH_ALEN);
|
|
_rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN);
|
|
break;
|
|
}
|
|
|
|
SetSeqNum(pwlanhdr, 0);
|
|
|
|
if (bQoS == _TRUE) {
|
|
struct rtw_ieee80211_hdr_3addr_qos *pwlanqoshdr;
|
|
|
|
SetFrameSubType(pframe, WIFI_QOS_DATA_NULL);
|
|
|
|
pwlanqoshdr = (struct rtw_ieee80211_hdr_3addr_qos *)pframe;
|
|
SetPriority(&pwlanqoshdr->qc, AC);
|
|
SetEOSP(&pwlanqoshdr->qc, bEosp);
|
|
|
|
pktlen = sizeof(struct rtw_ieee80211_hdr_3addr_qos);
|
|
} else {
|
|
SetFrameSubType(pframe, WIFI_DATA_NULL);
|
|
|
|
pktlen = sizeof(struct rtw_ieee80211_hdr_3addr);
|
|
}
|
|
|
|
*pLength = pktlen;
|
|
}
|
|
|
|
static void ConstructProbeRsp(PADAPTER adapter, u8 *pframe, u32 *pLength, u8 *StaAddr, BOOLEAN bHideSSID)
|
|
{
|
|
struct rtw_ieee80211_hdr *pwlanhdr;
|
|
u16 *fctrl;
|
|
u8 *mac, *bssid;
|
|
u32 pktlen;
|
|
struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv;
|
|
struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
|
|
WLAN_BSSID_EX *cur_network = &pmlmeinfo->network;
|
|
#if defined(CONFIG_AP_MODE) && defined(CONFIG_NATIVEAP_MLME)
|
|
u8 *pwps_ie;
|
|
uint wps_ielen;
|
|
struct mlme_priv *pmlmepriv = &adapter->mlmepriv;
|
|
#endif /* CONFIG_AP_MODE && CONFIG_NATIVEAP_MLME */
|
|
#ifdef CONFIG_P2P
|
|
struct wifidirect_info *pwdinfo = &adapter->wdinfo;
|
|
#ifdef CONFIG_WFD
|
|
u32 wfdielen = 0;
|
|
#endif /* CONFIG_WFD */
|
|
#endif /* CONFIG_P2P */
|
|
|
|
pwlanhdr = (struct rtw_ieee80211_hdr *)pframe;
|
|
|
|
mac = adapter_mac_addr(adapter);
|
|
bssid = cur_network->MacAddress;
|
|
|
|
fctrl = &(pwlanhdr->frame_ctl);
|
|
*(fctrl) = 0;
|
|
_rtw_memcpy(pwlanhdr->addr1, StaAddr, ETH_ALEN);
|
|
_rtw_memcpy(pwlanhdr->addr2, mac, ETH_ALEN);
|
|
_rtw_memcpy(pwlanhdr->addr3, bssid, ETH_ALEN);
|
|
|
|
RTW_INFO("%s FW Mac Addr:" MAC_FMT "\n", __FUNCTION__, MAC_ARG(mac));
|
|
RTW_INFO("%s FW IP Addr" IP_FMT "\n", __FUNCTION__, IP_ARG(StaAddr));
|
|
|
|
SetSeqNum(pwlanhdr, 0);
|
|
SetFrameSubType(fctrl, WIFI_PROBERSP);
|
|
|
|
pktlen = sizeof(struct rtw_ieee80211_hdr_3addr);
|
|
pframe += pktlen;
|
|
|
|
if (cur_network->IELength > MAX_IE_SZ)
|
|
return;
|
|
|
|
pwps_ie = rtw_get_wps_ie(cur_network->IEs + _FIXED_IE_LENGTH_,
|
|
cur_network->IELength - _FIXED_IE_LENGTH_, NULL, &wps_ielen);
|
|
|
|
/* inerset & update wps_probe_resp_ie */
|
|
if ((pmlmepriv->wps_probe_resp_ie != NULL) && pwps_ie && (wps_ielen > 0)) {
|
|
uint wps_offset, remainder_ielen;
|
|
u8 *premainder_ie;
|
|
|
|
wps_offset = (uint)(pwps_ie - cur_network->IEs);
|
|
|
|
premainder_ie = pwps_ie + wps_ielen;
|
|
|
|
remainder_ielen = cur_network->IELength - wps_offset - wps_ielen;
|
|
|
|
_rtw_memcpy(pframe, cur_network->IEs, wps_offset);
|
|
pframe += wps_offset;
|
|
pktlen += wps_offset;
|
|
|
|
wps_ielen = (uint)pmlmepriv->wps_probe_resp_ie[1];/* to get ie data len */
|
|
if ((wps_offset + wps_ielen + 2) <= MAX_IE_SZ) {
|
|
_rtw_memcpy(pframe, pmlmepriv->wps_probe_resp_ie, wps_ielen + 2);
|
|
pframe += wps_ielen + 2;
|
|
pktlen += wps_ielen + 2;
|
|
}
|
|
|
|
if ((wps_offset + wps_ielen + 2 + remainder_ielen) <= MAX_IE_SZ) {
|
|
_rtw_memcpy(pframe, premainder_ie, remainder_ielen);
|
|
pframe += remainder_ielen;
|
|
pktlen += remainder_ielen;
|
|
}
|
|
} else {
|
|
_rtw_memcpy(pframe, cur_network->IEs, cur_network->IELength);
|
|
pframe += cur_network->IELength;
|
|
pktlen += cur_network->IELength;
|
|
}
|
|
|
|
/* retrieve SSID IE from cur_network->Ssid */
|
|
{
|
|
u8 *ssid_ie;
|
|
sint ssid_ielen = 0;
|
|
sint ssid_ielen_diff;
|
|
u8 buf[MAX_IE_SZ];
|
|
u8 *ies = pframe + sizeof(struct rtw_ieee80211_hdr_3addr);
|
|
|
|
ssid_ie = rtw_get_ie(ies + _FIXED_IE_LENGTH_, _SSID_IE_, &ssid_ielen,
|
|
(pframe - ies) - _FIXED_IE_LENGTH_);
|
|
|
|
ssid_ielen_diff = cur_network->Ssid.SsidLength - ssid_ielen;
|
|
|
|
if (ssid_ie && cur_network->Ssid.SsidLength) {
|
|
uint remainder_ielen;
|
|
u8 *remainder_ie;
|
|
|
|
remainder_ie = ssid_ie + 2;
|
|
remainder_ielen = pframe - remainder_ie;
|
|
|
|
if (remainder_ielen > MAX_IE_SZ) {
|
|
RTW_WARN(FUNC_ADPT_FMT" remainder_ielen > MAX_IE_SZ\n", FUNC_ADPT_ARG(adapter));
|
|
remainder_ielen = MAX_IE_SZ;
|
|
}
|
|
|
|
_rtw_memcpy(buf, remainder_ie, remainder_ielen);
|
|
_rtw_memcpy(remainder_ie + ssid_ielen_diff, buf, remainder_ielen);
|
|
*(ssid_ie + 1) = cur_network->Ssid.SsidLength;
|
|
_rtw_memcpy(ssid_ie + 2, cur_network->Ssid.Ssid, cur_network->Ssid.SsidLength);
|
|
pframe += ssid_ielen_diff;
|
|
pktlen += ssid_ielen_diff;
|
|
}
|
|
}
|
|
|
|
#ifdef CONFIG_P2P
|
|
if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) {
|
|
u32 len;
|
|
#ifdef CONFIG_IOCTL_CFG80211
|
|
if (adapter_wdev_data(adapter)->p2p_enabled && (pwdinfo->driver_interface == DRIVER_CFG80211)) {
|
|
/* if pwdinfo->role == P2P_ROLE_DEVICE will call issue_probersp_p2p() */
|
|
len = pmlmepriv->p2p_go_probe_resp_ie_len;
|
|
if (pmlmepriv->p2p_go_probe_resp_ie && (len > 0))
|
|
_rtw_memcpy(pframe, pmlmepriv->p2p_go_probe_resp_ie, len);
|
|
} else
|
|
#endif /* CONFIG_IOCTL_CFG80211 */
|
|
{
|
|
len = build_probe_resp_p2p_ie(pwdinfo, pframe);
|
|
}
|
|
|
|
pframe += len;
|
|
pktlen += len;
|
|
|
|
#ifdef CONFIG_WFD
|
|
#ifdef CONFIG_IOCTL_CFG80211
|
|
if (_FALSE == pwdinfo->wfd_info->wfd_enable) {
|
|
len = 0;
|
|
if (pmlmepriv->wfd_probe_resp_ie && (pmlmepriv->wfd_probe_resp_ie_len > 0)) {
|
|
len = pmlmepriv->wfd_probe_resp_ie_len;
|
|
_rtw_memcpy(pframe, pmlmepriv->wfd_probe_resp_ie, len);
|
|
}
|
|
} else
|
|
#endif /* CONFIG_IOCTL_CFG80211 */
|
|
{
|
|
len = build_probe_resp_wfd_ie(pwdinfo, pframe, 0);
|
|
}
|
|
|
|
pframe += len;
|
|
pktlen += len;
|
|
#endif /* CONFIG_WFD */
|
|
}
|
|
#endif /* CONFIG_P2P */
|
|
|
|
*pLength = pktlen;
|
|
}
|
|
|
|
static void ConstructBtNullFunctionData(
|
|
PADAPTER adapter,
|
|
u8 *pframe,
|
|
u32 *pLength,
|
|
u8 *StaAddr,
|
|
u8 bQoS,
|
|
u8 AC,
|
|
u8 bEosp,
|
|
u8 bForcePowerSave)
|
|
{
|
|
struct rtw_ieee80211_hdr *pwlanhdr;
|
|
u16 *fctrl;
|
|
u32 pktlen;
|
|
struct mlme_ext_priv *pmlmeext;
|
|
struct mlme_ext_info *pmlmeinfo;
|
|
u8 bssid[ETH_ALEN];
|
|
|
|
|
|
RTW_INFO("+" FUNC_ADPT_FMT ": qos=%d eosp=%d ps=%d\n",
|
|
FUNC_ADPT_ARG(adapter), bQoS, bEosp, bForcePowerSave);
|
|
|
|
pwlanhdr = (struct rtw_ieee80211_hdr *)pframe;
|
|
pmlmeext = &adapter->mlmeextpriv;
|
|
pmlmeinfo = &pmlmeext->mlmext_info;
|
|
|
|
if (NULL == StaAddr) {
|
|
_rtw_memcpy(bssid, adapter_mac_addr(adapter), ETH_ALEN);
|
|
StaAddr = bssid;
|
|
}
|
|
|
|
fctrl = &pwlanhdr->frame_ctl;
|
|
*fctrl = 0;
|
|
if (bForcePowerSave)
|
|
SetPwrMgt(fctrl);
|
|
|
|
SetFrDs(fctrl);
|
|
_rtw_memcpy(pwlanhdr->addr1, StaAddr, ETH_ALEN);
|
|
_rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(adapter), ETH_ALEN);
|
|
_rtw_memcpy(pwlanhdr->addr3, adapter_mac_addr(adapter), ETH_ALEN);
|
|
|
|
SetDuration(pwlanhdr, 0);
|
|
SetSeqNum(pwlanhdr, 0);
|
|
|
|
if (bQoS == _TRUE) {
|
|
struct rtw_ieee80211_hdr_3addr_qos *pwlanqoshdr;
|
|
|
|
SetFrameSubType(pframe, WIFI_QOS_DATA_NULL);
|
|
|
|
pwlanqoshdr = (struct rtw_ieee80211_hdr_3addr_qos *)pframe;
|
|
SetPriority(&pwlanqoshdr->qc, AC);
|
|
SetEOSP(&pwlanqoshdr->qc, bEosp);
|
|
|
|
pktlen = sizeof(struct rtw_ieee80211_hdr_3addr_qos);
|
|
} else {
|
|
SetFrameSubType(pframe, WIFI_DATA_NULL);
|
|
|
|
pktlen = sizeof(struct rtw_ieee80211_hdr_3addr);
|
|
}
|
|
|
|
*pLength = pktlen;
|
|
}
|
|
|
|
static void SetFwRsvdPagePkt_BTCoex(PADAPTER adapter)
|
|
{
|
|
PHAL_DATA_TYPE hal;
|
|
struct xmit_frame *pcmdframe;
|
|
struct pkt_attrib *pattrib;
|
|
struct xmit_priv *pxmitpriv;
|
|
struct mlme_ext_priv *pmlmeext;
|
|
struct mlme_ext_info *pmlmeinfo;
|
|
u32 BeaconLength = 0;
|
|
u32 BTQosNullLength = 0;
|
|
u8 *ReservedPagePacket;
|
|
u8 TxDescLen, TxDescOffset;
|
|
u8 TotalPageNum = 0, CurtPktPageNum = 0, RsvdPageNum = 0;
|
|
u16 BufIndex, PageSize;
|
|
u32 TotalPacketLen, MaxRsvdPageBufSize = 0;
|
|
RSVDPAGE_LOC RsvdPageLoc;
|
|
|
|
|
|
hal = GET_HAL_DATA(adapter);
|
|
pxmitpriv = &adapter->xmitpriv;
|
|
pmlmeext = &adapter->mlmeextpriv;
|
|
pmlmeinfo = &pmlmeext->mlmext_info;
|
|
TxDescLen = TXDESC_SIZE;
|
|
TxDescOffset = TXDESC_OFFSET;
|
|
|
|
rtw_hal_get_def_var(adapter, HAL_DEF_TX_PAGE_SIZE, (u8 *)&PageSize);
|
|
RsvdPageNum = rtw_hal_get_txbuff_rsvd_page_num(adapter, _FALSE);
|
|
MaxRsvdPageBufSize = RsvdPageNum * PageSize;
|
|
|
|
pcmdframe = rtw_alloc_cmdxmitframe(pxmitpriv);
|
|
if (pcmdframe == NULL) {
|
|
RTW_INFO("%s: alloc ReservedPagePacket fail!\n", __FUNCTION__);
|
|
return;
|
|
}
|
|
|
|
ReservedPagePacket = pcmdframe->buf_addr;
|
|
_rtw_memset(&RsvdPageLoc, 0, sizeof(RSVDPAGE_LOC));
|
|
|
|
/* (1) beacon */
|
|
BufIndex = TxDescOffset;
|
|
ConstructBeacon(adapter, &ReservedPagePacket[BufIndex], &BeaconLength);
|
|
|
|
/*
|
|
* When we count the first page size, we need to reserve description size for the RSVD
|
|
* packet, it will be filled in front of the packet in TXPKTBUF.
|
|
*/
|
|
CurtPktPageNum = (u8)PageNum(TxDescLen + BeaconLength, PageSize);
|
|
/*
|
|
* If we don't add 1 more page, the WOWLAN function has a problem.
|
|
* Maybe it's a bug of firmware?
|
|
*/
|
|
if (CurtPktPageNum == 1)
|
|
CurtPktPageNum += 1;
|
|
TotalPageNum += CurtPktPageNum;
|
|
|
|
BufIndex += (CurtPktPageNum * PageSize);
|
|
|
|
/* Jump to lastest page */
|
|
if (BufIndex < (MaxRsvdPageBufSize - PageSize)) {
|
|
BufIndex = TxDescOffset + (MaxRsvdPageBufSize - PageSize);
|
|
TotalPageNum = RsvdPageNum - 1;
|
|
}
|
|
|
|
/* (6) BT Qos null data */
|
|
RsvdPageLoc.LocBTQosNull = TotalPageNum;
|
|
ConstructBtNullFunctionData(
|
|
adapter,
|
|
&ReservedPagePacket[BufIndex],
|
|
&BTQosNullLength,
|
|
NULL,
|
|
_TRUE, 0, 0, _FALSE);
|
|
rtw_hal_fill_fake_txdesc(adapter, &ReservedPagePacket[BufIndex - TxDescLen], BTQosNullLength, _FALSE, _TRUE, _FALSE);
|
|
|
|
CurtPktPageNum = (u8)PageNum(TxDescLen + BTQosNullLength, PageSize);
|
|
|
|
TotalPageNum += CurtPktPageNum;
|
|
|
|
TotalPacketLen = BufIndex + BTQosNullLength;
|
|
if (TotalPacketLen > MaxRsvdPageBufSize) {
|
|
RTW_INFO(FUNC_ADPT_FMT ": ERROR: The rsvd page size is not enough!!TotalPacketLen %d, MaxRsvdPageBufSize %d\n",
|
|
FUNC_ADPT_ARG(adapter), TotalPacketLen, MaxRsvdPageBufSize);
|
|
goto error;
|
|
}
|
|
|
|
/* update attribute */
|
|
pattrib = &pcmdframe->attrib;
|
|
update_mgntframe_attrib(adapter, pattrib);
|
|
pattrib->qsel = QSLT_BEACON;
|
|
pattrib->pktlen = pattrib->last_txcmdsz = TotalPacketLen - TxDescOffset;
|
|
#ifdef CONFIG_PCI_HCI
|
|
dump_mgntframe(adapter, pcmdframe);
|
|
#else /* !CONFIG_PCI_HCI */
|
|
dump_mgntframe_and_wait(adapter, pcmdframe, 100);
|
|
#endif /* !CONFIG_PCI_HCI */
|
|
|
|
rtl8822b_set_FwRsvdPage_cmd(adapter, &RsvdPageLoc);
|
|
rtl8822b_set_FwAoacRsvdPage_cmd(adapter, &RsvdPageLoc);
|
|
|
|
return;
|
|
|
|
error:
|
|
rtw_free_xmitframe(pxmitpriv, pcmdframe);
|
|
}
|
|
|
|
void rtl8822b_download_BTCoex_AP_mode_rsvd_page(PADAPTER adapter)
|
|
{
|
|
PHAL_DATA_TYPE hal;
|
|
struct mlme_ext_priv *pmlmeext;
|
|
struct mlme_ext_info *pmlmeinfo;
|
|
u8 bRecover = _FALSE;
|
|
u8 bcn_valid = _FALSE;
|
|
u8 DLBcnCount = 0;
|
|
u32 poll = 0;
|
|
u8 val8;
|
|
|
|
|
|
RTW_INFO("+" FUNC_ADPT_FMT ": hw_port=%d fw_state=0x%08X\n",
|
|
FUNC_ADPT_ARG(adapter), get_hw_port(adapter), get_fwstate(&adapter->mlmepriv));
|
|
|
|
#ifdef CONFIG_RTW_DEBUG
|
|
if (check_fwstate(&adapter->mlmepriv, WIFI_AP_STATE) == _FALSE) {
|
|
RTW_INFO(FUNC_ADPT_FMT ": [WARNING] not in AP mode!!\n",
|
|
FUNC_ADPT_ARG(adapter));
|
|
}
|
|
#endif /* CONFIG_RTW_DEBUG */
|
|
|
|
hal = GET_HAL_DATA(adapter);
|
|
pmlmeext = &adapter->mlmeextpriv;
|
|
pmlmeinfo = &pmlmeext->mlmext_info;
|
|
|
|
/* We should set AID, correct TSF, HW seq enable before set JoinBssReport to Fw in 88/92C. */
|
|
rtw_write16(adapter, REG_BCN_PSR_RPT, (0xC000 | pmlmeinfo->aid));
|
|
|
|
/* set REG_CR bit 8 */
|
|
val8 = rtw_read8(adapter, REG_CR + 1);
|
|
val8 |= BIT(0); /* ENSWBCN */
|
|
rtw_write8(adapter, REG_CR + 1, val8);
|
|
|
|
/*
|
|
* Disable Hw protection for a time which revserd for Hw sending beacon.
|
|
* Fix download reserved page packet fail that access collision with the protection time.
|
|
*/
|
|
val8 = rtw_read8(adapter, REG_BCN_CTRL);
|
|
val8 &= ~EN_BCN_FUNCTION;
|
|
val8 |= DIS_TSF_UDT;
|
|
rtw_write8(adapter, REG_BCN_CTRL, val8);
|
|
|
|
/* Set FWHW_TXQ_CTRL 0x422[6]=0 to tell Hw the packet is not a real beacon frame. */
|
|
if (hal->RegFwHwTxQCtrl & BIT(6))
|
|
bRecover = _TRUE;
|
|
|
|
/* To tell Hw the packet is not a real beacon frame. */
|
|
hal->RegFwHwTxQCtrl &= ~BIT(6);
|
|
rtw_write8(adapter, REG_FWHW_TXQ_CTRL + 2, hal->RegFwHwTxQCtrl);
|
|
|
|
/* Clear beacon valid check bit. */
|
|
rtw_hal_set_hwreg(adapter, HW_VAR_BCN_VALID, NULL);
|
|
rtw_hal_set_hwreg(adapter, HW_VAR_DL_BCN_SEL, NULL);
|
|
|
|
DLBcnCount = 0;
|
|
poll = 0;
|
|
do {
|
|
SetFwRsvdPagePkt_BTCoex(adapter);
|
|
DLBcnCount++;
|
|
do {
|
|
rtw_yield_os();
|
|
|
|
/* check rsvd page download OK. */
|
|
rtw_hal_get_hwreg(adapter, HW_VAR_BCN_VALID, &bcn_valid);
|
|
poll++;
|
|
} while (!bcn_valid && (poll % 10) != 0 && !RTW_CANNOT_RUN(adapter));
|
|
} while (!bcn_valid && (DLBcnCount <= 100) && !RTW_CANNOT_RUN(adapter));
|
|
|
|
if (_TRUE == bcn_valid) {
|
|
struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter);
|
|
|
|
pwrctl->fw_psmode_iface_id = adapter->iface_id;
|
|
RTW_INFO(ADPT_FMT": DL RSVD page success! DLBcnCount:%d, poll:%d\n",
|
|
ADPT_ARG(adapter), DLBcnCount, poll);
|
|
} else {
|
|
RTW_INFO(ADPT_FMT": DL RSVD page fail! DLBcnCount:%d, poll:%d\n",
|
|
ADPT_ARG(adapter), DLBcnCount, poll);
|
|
RTW_INFO(ADPT_FMT": DL RSVD page fail! bSurpriseRemoved=%s\n",
|
|
ADPT_ARG(adapter), rtw_is_surprise_removed(adapter) ? "True" : "False");
|
|
RTW_INFO(ADPT_FMT": DL RSVD page fail! bDriverStopped=%s\n",
|
|
ADPT_ARG(adapter), rtw_is_drv_stopped(adapter) ? "True" : "False");
|
|
}
|
|
|
|
val8 = rtw_read8(adapter, REG_BCN_CTRL);
|
|
val8 |= EN_BCN_FUNCTION;
|
|
val8 &= ~DIS_TSF_UDT;
|
|
rtw_write8(adapter, REG_BCN_CTRL, val8);
|
|
|
|
/*
|
|
* To make sure that if there exists an adapter which would like to send beacon.
|
|
* If exists, the origianl value of 0x422[6] will be 1, we should check this to
|
|
* prevent from setting 0x422[6] to 0 after download reserved page, or it will cause
|
|
* the beacon cannot be sent by HW.
|
|
*/
|
|
if (bRecover) {
|
|
hal->RegFwHwTxQCtrl |= BIT(6);
|
|
rtw_write8(adapter, REG_FWHW_TXQ_CTRL + 2, hal->RegFwHwTxQCtrl);
|
|
}
|
|
|
|
/* Clear CR[8] or beacon packet will not be send to TxBuf anymore. */
|
|
#ifndef CONFIG_PCI_HCI
|
|
val8 = rtw_read8(adapter, REG_CR + 1);
|
|
val8 &= ~BIT(0); /* ~ENSWBCN */
|
|
rtw_write8(adapter, REG_CR + 1, val8);
|
|
#endif /* !CONFIG_PCI_HCI */
|
|
}
|
|
#endif /* CONFIG_BT_COEXIST */
|
|
|
|
#ifdef CONFIG_P2P
|
|
void rtl8822b_set_p2p_ps_offload_cmd(PADAPTER adapter, u8 p2p_ps_state)
|
|
{
|
|
PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter);
|
|
struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter);
|
|
struct wifidirect_info *pwdinfo = &adapter->wdinfo;
|
|
u8 i;
|
|
u8 h2c[RTW_HALMAC_H2C_MAX_SIZE] = {0};
|
|
|
|
|
|
_rtw_memcpy(&h2c[1], &hal->p2p_ps_offload, sizeof(hal->p2p_ps_offload));
|
|
|
|
P2P_PS_OFFLOAD_SET_CMD_ID(h2c, CMD_ID_P2P_PS_OFFLOAD);
|
|
P2P_PS_OFFLOAD_SET_CLASS(h2c, CLASS_P2P_PS_OFFLOAD);
|
|
|
|
switch (p2p_ps_state) {
|
|
case P2P_PS_DISABLE:
|
|
RTW_INFO("P2P_PS_DISABLE\n");
|
|
_rtw_memset(&h2c[1], 0, sizeof(hal->p2p_ps_offload));
|
|
break;
|
|
|
|
case P2P_PS_ENABLE:
|
|
RTW_INFO("P2P_PS_ENABLE\n");
|
|
/* update CTWindow value. */
|
|
if (pwdinfo->ctwindow > 0) {
|
|
P2P_PS_OFFLOAD_SET_CTWINDOW_EN(h2c, 1);
|
|
rtw_write8(adapter, REG_CTWND_8822B, pwdinfo->ctwindow);
|
|
}
|
|
|
|
/* hw only support 2 set of NoA */
|
|
for (i = 0; i < pwdinfo->noa_num; i++) {
|
|
/* To control the register setting for which NOA */
|
|
rtw_write8(adapter, REG_TXCMD_NOA_SEL_8822B, (i << 4));
|
|
if (i == 0)
|
|
P2P_PS_OFFLOAD_SET_NOA0_EN(h2c, 1);
|
|
else
|
|
P2P_PS_OFFLOAD_SET_NOA1_EN(h2c, 1);
|
|
|
|
/* config P2P NoA Descriptor Register */
|
|
/* config NOA duration */
|
|
rtw_write32(adapter, REG_NOA_PARAM_8822B, pwdinfo->noa_duration[i]);
|
|
/* config NOA interval */
|
|
rtw_write32(adapter, (REG_NOA_PARAM_8822B + 4), pwdinfo->noa_interval[i]);
|
|
/* config NOA start time */
|
|
rtw_write32(adapter, (REG_NOA_PARAM_8822B + 8), pwdinfo->noa_start_time[i]);
|
|
/* config NOA count */
|
|
rtw_write8(adapter, (REG_NOA_PARAM_8822B + 12), pwdinfo->noa_count[i]);
|
|
}
|
|
|
|
if ((pwdinfo->opp_ps == 1) || (pwdinfo->noa_num > 0)) {
|
|
/* rst p2p circuit */
|
|
rtw_write8(adapter, REG_P2P_RST_8822B, BIT(0));
|
|
|
|
P2P_PS_OFFLOAD_SET_OFFLOAD_EN(h2c, 1);
|
|
|
|
if (pwdinfo->role == P2P_ROLE_GO) {
|
|
P2P_PS_OFFLOAD_SET_ROLE(h2c, 1);
|
|
P2P_PS_OFFLOAD_SET_ALL_STA_SLEEP(h2c, 0);
|
|
} else
|
|
P2P_PS_OFFLOAD_SET_ROLE(h2c, 0);
|
|
|
|
((struct P2P_PS_Offload_t *)&h2c[1])->discovery = 0;
|
|
}
|
|
break;
|
|
|
|
case P2P_PS_SCAN:
|
|
RTW_INFO("P2P_PS_SCAN\n");
|
|
((struct P2P_PS_Offload_t *)&h2c[1])->discovery = 1;
|
|
break;
|
|
|
|
case P2P_PS_SCAN_DONE:
|
|
RTW_INFO("P2P_PS_SCAN_DONE\n");
|
|
((struct P2P_PS_Offload_t *)&h2c[1])->discovery = 0;
|
|
pwdinfo->p2p_ps_state = P2P_PS_ENABLE;
|
|
break;
|
|
|
|
default:
|
|
break;
|
|
}
|
|
|
|
RTW_DBG_DUMP("H2C-P2PPSOffload Parm:", h2c, RTW_HALMAC_H2C_MAX_SIZE);
|
|
rtw_halmac_send_h2c(adapter_to_dvobj(adapter), h2c);
|
|
|
|
_rtw_memcpy(&hal->p2p_ps_offload, &h2c[1], sizeof(hal->p2p_ps_offload));
|
|
}
|
|
#endif /* CONFIG_P2P */
|
|
|
|
#ifdef CONFIG_TSF_RESET_OFFLOAD
|
|
/*
|
|
* ask FW to Reset sync register at Beacon early interrupt
|
|
*/
|
|
u8 rtl8822b_reset_tsf(PADAPTER adapter, u8 reset_port)
|
|
{
|
|
u8 buf[2];
|
|
u8 res = _SUCCESS;
|
|
|
|
|
|
if (HW_PORT0 == reset_port) {
|
|
buf[0] = 0x1;
|
|
buf[1] = 0;
|
|
} else {
|
|
buf[0] = 0x0;
|
|
buf[1] = 0x1;
|
|
}
|
|
|
|
rtl8822b_fillh2ccmd(adapter, H2C_RESET_TSF, 2, buf);
|
|
|
|
return res;
|
|
}
|
|
#endif /* CONFIG_TSF_RESET_OFFLOAD */
|
|
|
|
|
|
void rtl8822b_fw_update_beacon_cmd(PADAPTER adapter)
|
|
{
|
|
}
|
|
|
|
/*
|
|
* Below functions are for C2H
|
|
*/
|
|
static void c2h_ccx_rpt(PADAPTER adapter, u8 *pdata)
|
|
{
|
|
#ifdef CONFIG_XMIT_ACK
|
|
u8 seq_no, retry_over, life_time_over;
|
|
|
|
|
|
seq_no = C2H_CCX_RPT_GET_SEQ(pdata);
|
|
retry_over = C2H_CCX_RPT_GET_RETRY_OVER(pdata);
|
|
life_time_over = C2H_CCX_RPT_GET_LIFE_TIME_OVER(pdata);
|
|
|
|
if (retry_over || life_time_over)
|
|
rtw_ack_tx_done(&adapter->xmitpriv, RTW_SCTX_DONE_CCX_PKT_FAIL);
|
|
else
|
|
rtw_ack_tx_done(&adapter->xmitpriv, RTW_SCTX_DONE_SUCCESS);
|
|
#endif /* CONFIG_XMIT_ACK */
|
|
}
|
|
|
|
/**
|
|
* c2h = RXDESC + c2h packet
|
|
* size = RXDESC_SIZE + c2h packet size
|
|
* c2h payload = c2h packet revmoe id & seq
|
|
*/
|
|
static void process_c2h_event(PADAPTER adapter, u8 *c2h, u32 size)
|
|
{
|
|
PHAL_DATA_TYPE hal;
|
|
struct mlme_ext_priv *pmlmeext;
|
|
struct mlme_ext_info *pmlmeinfo;
|
|
PDM_ODM_T pDM_Odm;
|
|
u8 id, seq;
|
|
u8 c2h_len, c2h_payload_len;
|
|
u8 *pc2h_data, *pc2h_payload;
|
|
|
|
|
|
if (!c2h) {
|
|
RTW_INFO("%s: c2h buffer is NULL!!\n", __FUNCTION__);
|
|
return;
|
|
}
|
|
|
|
if (size < HALMAC_RX_DESC_SIZE_8822B) {
|
|
RTW_INFO("%s: c2h length(%d) is smaller than RXDESC_SIZE(%d)!!\n",
|
|
__FUNCTION__, size, HALMAC_RX_DESC_SIZE_8822B);
|
|
return;
|
|
}
|
|
|
|
hal = GET_HAL_DATA(adapter);
|
|
pDM_Odm = &hal->odmpriv;
|
|
pmlmeext = &adapter->mlmeextpriv;
|
|
pmlmeinfo = &pmlmeext->mlmext_info;
|
|
|
|
/* shift rx desc len */
|
|
pc2h_data = c2h + HALMAC_RX_DESC_SIZE_8822B;
|
|
c2h_len = size - HALMAC_RX_DESC_SIZE_8822B;
|
|
|
|
id = C2H_GET_CMD_ID(pc2h_data);
|
|
seq = C2H_GET_SEQ(pc2h_data);
|
|
|
|
/* shift 2 byte to remove cmd id & seq */
|
|
pc2h_payload = pc2h_data + 2;
|
|
c2h_payload_len = c2h_len - 2;
|
|
|
|
switch (id) {
|
|
case CMD_ID_C2H_CCX_RPT:
|
|
c2h_ccx_rpt(adapter, pc2h_data);
|
|
break;
|
|
#ifdef CONFIG_BT_COEXIST
|
|
case C2H_BT_INFO:
|
|
rtw_btcoex_BtInfoNotify(adapter, c2h_payload_len, pc2h_payload);
|
|
break;
|
|
case C2H_BT_MP_INFO:
|
|
rtw_btcoex_BtMpRptNotify(adapter, c2h_payload_len, pc2h_payload);
|
|
break;
|
|
case C2H_BT_SCOREBOARD_STATUS:
|
|
rtw_btcoex_ScoreBoardStatusNotify(adapter, c2h_payload_len, pc2h_payload);
|
|
break;
|
|
#endif
|
|
/* FW offload C2H is 0xFF cmd according to halmac function - halmac_parse_c2h_packet */
|
|
case 0xFF:
|
|
/* indicate c2h pkt + rx desc to halmac */
|
|
rtw_halmac_c2h_handle(adapter_to_dvobj(adapter), c2h, size);
|
|
break;
|
|
/* others for phydm */
|
|
default:
|
|
if (!(phydm_c2H_content_parsing(pDM_Odm, id, c2h_payload_len, pc2h_payload)))
|
|
RTW_INFO("%s: [WARNING] unknown C2H(0x%02x)\n", __FUNCTION__, id);
|
|
break;
|
|
}
|
|
}
|
|
|
|
void rtl8822b_c2h_handler(PADAPTER adapter, u8 *pbuf, u16 length)
|
|
{
|
|
#ifdef CONFIG_WOWLAN
|
|
struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter);
|
|
|
|
if (pwrpriv->wowlan_mode == _TRUE) {
|
|
RTW_INFO("%s: return because wowolan_mode==TRUE! CMDID=%d\n",
|
|
__FUNCTION__, C2H_GET_CMD_ID(pbuf + RXDESC_SIZE));
|
|
return;
|
|
}
|
|
#endif /* CONFIG_WOWLAN*/
|
|
|
|
process_c2h_event(adapter, pbuf, length);
|
|
}
|
|
|
|
/**
|
|
* pbuf = RXDESC + c2h packet
|
|
* length = RXDESC_SIZE + c2h packet size
|
|
*/
|
|
void rtl8822b_c2h_handler_no_io(PADAPTER adapter, u8 *pbuf, u16 length)
|
|
{
|
|
u8 id, seq, c2h_size;
|
|
u8 *pc2h_content;
|
|
|
|
|
|
if ((length == 0) || (!pbuf))
|
|
return;
|
|
|
|
/* shift rx desc len to get c2h packet content */
|
|
pc2h_content = pbuf + HALMAC_RX_DESC_SIZE_8822B;
|
|
id = C2H_GET_CMD_ID(pc2h_content);
|
|
seq = C2H_GET_SEQ(pc2h_content);
|
|
|
|
RTW_INFO("%s: C2H, ID=%d seq=%d len=%d\n",
|
|
__FUNCTION__, id, seq, length);
|
|
|
|
switch (id) {
|
|
/* no I/O, process directly */
|
|
case CMD_ID_C2H_CCX_RPT:
|
|
process_c2h_event(adapter, pbuf, length);
|
|
break;
|
|
|
|
/* need I/O, run in command thread */
|
|
default:
|
|
if (rtw_c2h_packet_wk_cmd(adapter, pbuf, length) == _FAIL)
|
|
RTW_ERR("%s: C2H(%d) enqueue FAIL!\n", __FUNCTION__, id);
|
|
break;
|
|
}
|
|
}
|