1 /******************************************************************************
2 *
3 * Copyright(c) 2015 - 2019 Realtek Corporation.
4 *
5 * This program is free software; you can redistribute it and/or modify it
6 * under the terms of version 2 of the GNU General Public License as
7 * published by the Free Software Foundation.
8 *
9 * This program is distributed in the hope that it will be useful, but WITHOUT
10 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
11 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
12 * more details.
13 *
14 *****************************************************************************/
15 #define _RTL8822B_CMD_C_
16
17 #include <hal_data.h> /* HAL_DATA_TYPE */
18 #include "../hal_halmac.h" /* HRTW_HALMAC_H2C_MAX_SIZE, CMD_ID_RSVD_PAGE and etc. */
19 #include "rtl8822b.h"
20
21 /*
22 * Below functions are for C2H
23 */
24 /*****************************************
25 * H2C Msg format :
26 *| 31 - 8 |7-5 | 4 - 0 |
27 *| h2c_msg |Class |CMD_ID |
28 *| 31-0 |
29 *| Ext msg |
30 *
31 ******************************************/
rtl8822b_fillh2ccmd(PADAPTER adapter,u8 id,u32 buf_len,u8 * pbuf)32 s32 rtl8822b_fillh2ccmd(PADAPTER adapter, u8 id, u32 buf_len, u8 *pbuf)
33 {
34 u8 h2c[RTW_HALMAC_H2C_MAX_SIZE] = {0};
35 #ifdef CONFIG_RTW_DEBUG
36 u8 msg[(RTW_HALMAC_H2C_MAX_SIZE - 1) * 5 + 1] = {0};
37 u8 *msg_p;
38 u32 msg_size, i, n;
39 #endif /* CONFIG_RTW_DEBUG */
40 int err;
41 s32 ret = _FAIL;
42
43
44 if (!pbuf)
45 goto exit;
46
47 if (buf_len > (RTW_HALMAC_H2C_MAX_SIZE - 1))
48 goto exit;
49
50 if (rtw_is_surprise_removed(adapter))
51 goto exit;
52
53 #ifdef CONFIG_RTW_DEBUG
54 msg_p = msg;
55 msg_size = (RTW_HALMAC_H2C_MAX_SIZE - 1) * 5 + 1;
56 for (i = 0; i < buf_len; i++) {
57 n = rtw_sprintf(msg_p, msg_size, " 0x%02x", pbuf[i]);
58 msg_p += n;
59 msg_size -= n;
60 if (msg_size == 0)
61 break;
62 }
63 RTW_DBG(FUNC_ADPT_FMT ": id=0x%02x buf=%s\n",
64 FUNC_ADPT_ARG(adapter), id, msg);
65 #endif /* CONFIG_RTW_DEBUG */
66
67 h2c[0] = id;
68 _rtw_memcpy(h2c + 1, pbuf, buf_len);
69
70 err = rtw_halmac_send_h2c(adapter_to_dvobj(adapter), h2c);
71 if (!err)
72 ret = _SUCCESS;
73
74 exit:
75
76 return ret;
77 }
78
rtl8822b_req_txrpt_cmd(PADAPTER adapter,u8 macid)79 void rtl8822b_req_txrpt_cmd(PADAPTER adapter, u8 macid)
80 {
81 u8 h2c[RTW_HALMAC_H2C_MAX_SIZE] = {0};
82
83 AP_REQ_TXRPT_SET_CMD_ID(h2c, CMD_ID_AP_REQ_TXRPT);
84 AP_REQ_TXRPT_SET_CLASS(h2c, CLASS_AP_REQ_TXRPT);
85
86 AP_REQ_TXRPT_SET_STA1_MACID(h2c, macid);
87 AP_REQ_TXRPT_SET_STA2_MACID(h2c, 0xff);
88 AP_REQ_TXRPT_SET_RTY_OK_TOTAL(h2c, 0x00);
89 AP_REQ_TXRPT_SET_RTY_CNT_MACID(h2c, 0x00);
90 rtw_halmac_send_h2c(adapter_to_dvobj(adapter), h2c);
91
92 AP_REQ_TXRPT_SET_RTY_CNT_MACID(h2c, 0x01);
93 rtw_halmac_send_h2c(adapter_to_dvobj(adapter), h2c);
94 }
95
96 #define SET_PWR_MODE_SET_BCN_RECEIVING_TIME(h2c_pkt, value) \
97 SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 24, 5, value)
98 #define SET_PWR_MODE_SET_ADOPT_BCN_RECEIVING_TIME(h2c_pkt, value) \
99 SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 31, 1, value)
100
rtl8822b_set_FwPwrMode_cmd(PADAPTER adapter,u8 psmode)101 void rtl8822b_set_FwPwrMode_cmd(PADAPTER adapter, u8 psmode)
102 {
103 int i;
104 u8 smart_ps = 0, mode = 0;
105 struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter);
106 #ifdef CONFIG_BCN_RECV_TIME
107 u8 bcn_recv_time;
108 struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv;
109 #endif
110 #ifdef CONFIG_WMMPS_STA
111 struct mlme_priv *pmlmepriv = &(adapter->mlmepriv);
112 struct qos_priv *pqospriv = &pmlmepriv->qospriv;
113 #endif /* CONFIG_WMMPS_STA */
114 u8 h2c[RTW_HALMAC_H2C_MAX_SIZE] = {0};
115 u8 PowerState = 0, awake_intvl = 1, rlbm = 0;
116 u8 allQueueUAPSD = 0;
117 char *fw_psmode_str = "UNSPECIFIED";
118 #ifdef CONFIG_P2P
119 struct wifidirect_info *wdinfo = &adapter->wdinfo;
120 #endif /* CONFIG_P2P */
121 u8 hw_port = rtw_hal_get_port(adapter);
122
123 if (pwrpriv->dtim > 0)
124 RTW_INFO(FUNC_ADPT_FMT ": dtim=%d, HW port id=%d\n", FUNC_ADPT_ARG(adapter),
125 pwrpriv->dtim, psmode == PS_MODE_ACTIVE ? pwrpriv->current_lps_hw_port_id : hw_port);
126 else
127 RTW_INFO(FUNC_ADPT_FMT ": HW port id=%d\n", FUNC_ADPT_ARG(adapter),
128 psmode == PS_MODE_ACTIVE ? pwrpriv->current_lps_hw_port_id : hw_port);
129
130 if (psmode == PS_MODE_MIN || psmode == PS_MODE_MAX) {
131 #ifdef CONFIG_WMMPS_STA
132 if (rtw_is_wmmps_mode(adapter)) {
133 mode = 2;
134
135 smart_ps = pwrpriv->wmm_smart_ps;
136
137 /* (WMMPS) allQueueUAPSD: 0: PSPoll, 1: QosNullData (if wmm_smart_ps=1) or do nothing (if wmm_smart_ps=2) */
138 if ((pqospriv->uapsd_tid & BIT_MASK_TID_TC) == ALL_TID_TC_SUPPORTED_UAPSD)
139 allQueueUAPSD = 1;
140 } else
141 #endif /* CONFIG_WMMPS_STA */
142 {
143 mode = 1;
144 #ifdef CONFIG_WMMPS_STA
145 /* For WMMPS test case, the station must retain sleep mode to capture buffered data on LPS mechanism */
146 if ((pqospriv->uapsd_tid & BIT_MASK_TID_TC) != 0)
147 smart_ps = 0;
148 else
149 #endif /* CONFIG_WMMPS_STA */
150 {
151 smart_ps = pwrpriv->smart_ps;
152 }
153 }
154
155 if (psmode == PS_MODE_MIN)
156 rlbm = 0;
157 else
158 rlbm = 1;
159 } else if (psmode == PS_MODE_DTIM) {
160 mode = 1;
161 /* For WOWLAN LPS, DTIM = (awake_intvl - 1) */
162 if (pwrpriv->dtim > 0 && pwrpriv->dtim < 16)
163 /* DTIM = (awake_intvl - 1) */
164 awake_intvl = pwrpriv->dtim + 1;
165 else
166 /* DTIM = 3 */
167 awake_intvl = 4;
168
169 rlbm = 2;
170 smart_ps = pwrpriv->smart_ps;
171 } else if (psmode == PS_MODE_ACTIVE) {
172 mode = 0;
173 } else {
174 rlbm = 2;
175 awake_intvl = 4;
176 smart_ps = pwrpriv->smart_ps;
177 }
178
179 #ifdef CONFIG_P2P
180 if (!rtw_p2p_chk_state(wdinfo, P2P_STATE_NONE)) {
181 awake_intvl = 2;
182 rlbm = 1;
183 }
184 #endif /* CONFIG_P2P */
185
186 if (adapter->registrypriv.wifi_spec == 1) {
187 awake_intvl = 2;
188 rlbm = 1;
189 }
190
191 if (psmode > 0) {
192 #ifdef CONFIG_BT_COEXIST
193 if (rtw_btcoex_IsBtControlLps(adapter) == _TRUE)
194 PowerState = rtw_btcoex_RpwmVal(adapter);
195 else
196 #endif /* CONFIG_BT_COEXIST */
197 PowerState = 0x00; /* AllON(0x0C), RFON(0x04), RFOFF(0x00) */
198 } else
199 PowerState = 0x0C; /* AllON(0x0C), RFON(0x04), RFOFF(0x00) */
200
201 if (mode == 0)
202 fw_psmode_str = "ACTIVE";
203 else if (mode == 1)
204 fw_psmode_str = "LPS";
205 else if (mode == 2)
206 fw_psmode_str = "WMMPS";
207
208 RTW_INFO(FUNC_ADPT_FMT": fw ps mode = %s, drv ps mode = %d, rlbm = %d , smart_ps = %d, allQueueUAPSD = %d\n",
209 FUNC_ADPT_ARG(adapter), fw_psmode_str, psmode, rlbm, smart_ps, allQueueUAPSD);
210
211 SET_PWR_MODE_SET_CMD_ID(h2c, CMD_ID_SET_PWR_MODE);
212 SET_PWR_MODE_SET_CLASS(h2c, CLASS_SET_PWR_MODE);
213 SET_PWR_MODE_SET_MODE(h2c, mode);
214 SET_PWR_MODE_SET_SMART_PS(h2c, smart_ps);
215 SET_PWR_MODE_SET_RLBM(h2c, rlbm);
216 SET_PWR_MODE_SET_AWAKE_INTERVAL(h2c, awake_intvl);
217 SET_PWR_MODE_SET_B_ALL_QUEUE_UAPSD(h2c, allQueueUAPSD);
218 SET_PWR_MODE_SET_PWR_STATE(h2c, PowerState);
219 if (psmode == PS_MODE_ACTIVE) {
220 /* Leave LPS, set the same HW port ID */
221 SET_PWR_MODE_SET_PORT_ID(h2c, pwrpriv->current_lps_hw_port_id);
222 } else {
223 /* Enter LPS, record HW port ID */
224 SET_PWR_MODE_SET_PORT_ID(h2c, hw_port);
225 pwrpriv->current_lps_hw_port_id = hw_port;
226 }
227 #ifdef CONFIG_BCN_RECV_TIME
228 if (pmlmeext->bcn_rx_time) {
229 bcn_recv_time = pmlmeext->bcn_rx_time / 128; /*unit : 128 us*/
230 if (pmlmeext->bcn_rx_time % 128)
231 bcn_recv_time += 1;
232
233 if (bcn_recv_time > 31)
234 bcn_recv_time = 31;
235 SET_PWR_MODE_SET_ADOPT_BCN_RECEIVING_TIME(h2c, 1);
236 SET_PWR_MODE_SET_BCN_RECEIVING_TIME(h2c, bcn_recv_time);
237 }
238 #endif
239
240 #ifdef CONFIG_BT_COEXIST
241 rtw_btcoex_RecordPwrMode(adapter, h2c + 1, RTW_HALMAC_H2C_MAX_SIZE - 1);
242 #endif /* CONFIG_BT_COEXIST */
243
244 RTW_DBG_DUMP("H2C-PwrMode Parm:", h2c, RTW_HALMAC_H2C_MAX_SIZE);
245 rtw_halmac_send_h2c(adapter_to_dvobj(adapter), h2c);
246 }
247
248 #ifdef CONFIG_TDLS
249 #ifdef CONFIG_TDLS_CH_SW
rtl8822b_set_BcnEarly_C2H_Rpt_cmd(PADAPTER padapter,u8 enable)250 void rtl8822b_set_BcnEarly_C2H_Rpt_cmd(PADAPTER padapter, u8 enable)
251 {
252 u8 u1H2CSetPwrMode[RTW_HALMAC_H2C_MAX_SIZE] = {0};
253
254 SET_PWR_MODE_SET_CMD_ID(u1H2CSetPwrMode, CMD_ID_SET_PWR_MODE);
255 SET_PWR_MODE_SET_CLASS(u1H2CSetPwrMode, CLASS_SET_PWR_MODE);
256 SET_PWR_MODE_SET_MODE(u1H2CSetPwrMode, 1);
257 SET_PWR_MODE_SET_RLBM(u1H2CSetPwrMode, 1);
258 SET_PWR_MODE_SET_BCN_EARLY_RPT(u1H2CSetPwrMode, enable);
259 SET_PWR_MODE_SET_PWR_STATE(u1H2CSetPwrMode, 0x0C);
260
261 rtw_halmac_send_h2c(adapter_to_dvobj(padapter), u1H2CSetPwrMode);
262 }
263 #endif
264 #endif
265
rtl8822b_set_FwPwrModeInIPS_cmd(PADAPTER adapter,u8 cmd_param)266 void rtl8822b_set_FwPwrModeInIPS_cmd(PADAPTER adapter, u8 cmd_param)
267 {
268
269 u8 h2c[RTW_HALMAC_H2C_MAX_SIZE] = {0};
270
271 INACTIVE_PS_SET_CMD_ID(h2c, CMD_ID_INACTIVE_PS);
272 INACTIVE_PS_SET_CLASS(h2c, CLASS_INACTIVE_PS);
273
274 if (cmd_param & BIT0)
275 INACTIVE_PS_SET_ENABLE(h2c, 1);
276
277 if (cmd_param & BIT1)
278 INACTIVE_PS_SET_IGNORE_PS_CONDITION(h2c, 1);
279
280 RTW_DBG_DUMP("H2C-FwPwrModeInIPS Parm:", h2c, RTW_HALMAC_H2C_MAX_SIZE);
281 rtw_halmac_send_h2c(adapter_to_dvobj(adapter), h2c);
282 }
283
284 #ifdef CONFIG_WOWLAN
rtl8822b_set_fw_pwrmode_inips_cmd_wowlan(PADAPTER padapter,u8 ps_mode)285 void rtl8822b_set_fw_pwrmode_inips_cmd_wowlan(PADAPTER padapter, u8 ps_mode)
286 {
287 struct registry_priv *registry_par = &padapter->registrypriv;
288 u8 param[H2C_INACTIVE_PS_LEN] = {0};
289 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
290
291 RTW_INFO("%s, ps_mode: %d\n", __func__, ps_mode);
292 if (ps_mode == PS_MODE_ACTIVE) {
293 SET_H2CCMD_INACTIVE_PS_EN(param, 0);
294 }
295 else {
296 SET_H2CCMD_INACTIVE_PS_EN(param, 1);
297 if(registry_par->suspend_type == FW_IPS_DISABLE_BBRF && !check_fwstate(pmlmepriv, _FW_LINKED))
298 SET_H2CCMD_INACTIVE_DISBBRF(param, 1);
299 if(registry_par->suspend_type == FW_IPS_WRC) {
300 SET_H2CCMD_INACTIVE_PERIOD_SCAN_EN(param, 1);
301 SET_H2CCMD_INACTIVE_PS_FREQ(param, 3);
302 SET_H2CCMD_INACTIVE_PS_DURATION(param, 1);
303 SET_H2CCMD_INACTIVE_PS_PERIOD_SCAN_TIME(param, 3);
304 }
305 }
306
307 rtl8822b_fillh2ccmd(padapter, H2C_INACTIVE_PS_, sizeof(param), param);
308 }
309 #endif /* CONFIG_WOWLAN */
310
311 #ifdef CONFIG_LPS_PWR_TRACKING
312 #define CLASS_FW_THERMAL_RPT 0x06
313 #define CMD_ID_FW_THERMAL_RPT 0x0B
314
315 #define SET_FW_THERMAL_RPT_SET_CMD_ID(__pH2C, __Value) SET_BITS_TO_LE_4BYTE(__pH2C + 0X00, 0, 5, __Value)
316 #define SET_FW_THERMAL_RPT_SET_CLASS(__pH2C, __Value) SET_BITS_TO_LE_4BYTE(__pH2C + 0X00, 5, 3, __Value)
317
318 #define SET_FW_THERMAL_RPT_SET_DETECT_EN(__pH2C, __Value) SET_BITS_TO_LE_4BYTE(__pH2C + 0X00, 8, 1, __Value)
319 #define SET_FW_THERMAL_RPT_SET_DETECT_VALUE(__pH2C, __Value) SET_BITS_TO_LE_4BYTE(__pH2C + 0X00, 16, 8, __Value)
320 #define SET_FW_THERMAL_RPT_SET_DETECT_PERIOD(__pH2C, __Value) SET_BITS_TO_LE_4BYTE(__pH2C + 0X00, 24, 8, __Value)
321
rtl8822b_set_fw_thermal_rpt_cmd(_adapter * adapter,u8 enable,u8 thermal_value)322 void rtl8822b_set_fw_thermal_rpt_cmd(_adapter *adapter, u8 enable, u8 thermal_value)
323 {
324 u8 h2c[RTW_HALMAC_H2C_MAX_SIZE] = {0};
325
326 SET_FW_THERMAL_RPT_SET_CLASS(h2c, CLASS_FW_THERMAL_RPT);
327 SET_FW_THERMAL_RPT_SET_CMD_ID(h2c, CMD_ID_FW_THERMAL_RPT);
328
329 if (enable) {
330 SET_FW_THERMAL_RPT_SET_DETECT_EN(h2c, 1);
331 SET_FW_THERMAL_RPT_SET_DETECT_VALUE(h2c, thermal_value);
332 SET_FW_THERMAL_RPT_SET_DETECT_PERIOD(h2c, 19);/*0:100ms,1:200ms, 9:1s, 19:2s*/
333 } else {
334 SET_FW_THERMAL_RPT_SET_DETECT_EN(h2c, 0);
335 }
336 rtw_halmac_send_h2c(adapter_to_dvobj(adapter), h2c);
337 }
338 #endif
339
340
341 #ifdef CONFIG_BT_COEXIST
rtl8822b_download_BTCoex_AP_mode_rsvd_page(PADAPTER adapter)342 void rtl8822b_download_BTCoex_AP_mode_rsvd_page(PADAPTER adapter)
343 {
344 hw_var_set_dl_rsvd_page(adapter, RT_MEDIA_CONNECT);
345 }
346 #endif /* CONFIG_BT_COEXIST */
347
348
349 /*
350 * Below functions are for C2H
351 */
c2h_ccx_rpt(PADAPTER adapter,u8 * pdata)352 static void c2h_ccx_rpt(PADAPTER adapter, u8 *pdata)
353 {
354 #ifdef CONFIG_XMIT_ACK
355 u8 tx_state;
356
357
358 tx_state = CCX_RPT_GET_TX_STATE(pdata);
359
360 /* 0 means success, 1 means retry drop */
361 if (tx_state == 0)
362 rtw_ack_tx_done(&adapter->xmitpriv, RTW_SCTX_DONE_SUCCESS);
363 else
364 rtw_ack_tx_done(&adapter->xmitpriv, RTW_SCTX_DONE_CCX_PKT_FAIL);
365 #endif /* CONFIG_XMIT_ACK */
366 }
367
368 static void
C2HTxRPTHandler_8822b(PADAPTER Adapter,u8 * CmdBuf,u8 CmdLen)369 C2HTxRPTHandler_8822b(
370 PADAPTER Adapter,
371 u8 *CmdBuf,
372 u8 CmdLen
373 )
374 {
375 _irqL irqL;
376 u8 macid = 0, IniRate = 0;
377 u16 TxOK = 0, TxFail = 0;
378 struct sta_priv *pstapriv = &(GET_PRIMARY_ADAPTER(Adapter))->stapriv, *pstapriv_original = NULL;
379 u8 TxOK0 = 0, TxOK1 = 0;
380 u8 TxFail0 = 0, TxFail1 = 0;
381 struct sta_info *psta = NULL;
382 PADAPTER adapter_ognl = NULL;
383
384 if(!pstapriv->gotc2h) {
385 RTW_WARN("%s,%d: No gotc2h!\n", __FUNCTION__, __LINE__);
386 return;
387 }
388
389 adapter_ognl = rtw_get_iface_by_id(GET_PRIMARY_ADAPTER(Adapter), pstapriv->c2h_adapter_id);
390 if(!adapter_ognl) {
391 RTW_WARN("%s: No adapter!\n", __FUNCTION__);
392 return;
393 }
394
395 psta = rtw_get_stainfo(&adapter_ognl->stapriv, pstapriv->c2h_sta_mac);
396 if (!psta) {
397 RTW_WARN("%s: No corresponding sta_info!\n", __FUNCTION__);
398 return;
399 }
400
401 macid = C2H_AP_REQ_TXRPT_GET_STA1_MACID(CmdBuf);
402 TxOK0 = C2H_AP_REQ_TXRPT_GET_TX_OK1_0(CmdBuf);
403 TxOK1 = C2H_AP_REQ_TXRPT_GET_TX_OK1_1(CmdBuf);
404 TxOK = (TxOK1 << 8) | TxOK0;
405 TxFail0 = C2H_AP_REQ_TXRPT_GET_TX_FAIL1_0(CmdBuf);
406 TxFail1 = C2H_AP_REQ_TXRPT_GET_TX_FAIL1_1(CmdBuf);
407 TxFail = (TxFail1 << 8) | TxFail0;
408 IniRate = C2H_AP_REQ_TXRPT_GET_INITIAL_RATE1(CmdBuf);
409
410 psta->sta_stats.tx_ok_cnt = TxOK;
411 psta->sta_stats.tx_fail_cnt = TxFail;
412
413 }
414
415 static void
C2HSPC_STAT_8822b(PADAPTER Adapter,u8 * CmdBuf,u8 CmdLen)416 C2HSPC_STAT_8822b(
417 PADAPTER Adapter,
418 u8 *CmdBuf,
419 u8 CmdLen
420 )
421 {
422 _irqL irqL;
423 struct sta_priv *pstapriv = &(GET_PRIMARY_ADAPTER(Adapter))->stapriv;
424 struct sta_info *psta = NULL;
425 struct sta_info *pbcmc_stainfo = rtw_get_bcmc_stainfo(Adapter);
426 _list *plist, *phead;
427 u8 idx = C2H_SPECIAL_STATISTICS_GET_STATISTICS_IDX(CmdBuf);
428 PADAPTER adapter_ognl = NULL;
429
430 if(!pstapriv->gotc2h) {
431 RTW_WARN("%s, %d: No gotc2h!\n", __FUNCTION__, __LINE__);
432 return;
433 }
434
435 adapter_ognl = rtw_get_iface_by_id(GET_PRIMARY_ADAPTER(Adapter), pstapriv->c2h_adapter_id);
436 if(!adapter_ognl) {
437 RTW_WARN("%s: No adapter!\n", __FUNCTION__);
438 return;
439 }
440
441 psta = rtw_get_stainfo(&adapter_ognl->stapriv, pstapriv->c2h_sta_mac);
442 if (!psta) {
443 RTW_WARN("%s: No corresponding sta_info!\n", __FUNCTION__);
444 return;
445 }
446 psta->sta_stats.tx_retry_cnt = (C2H_SPECIAL_STATISTICS_GET_DATA3(CmdBuf) << 8) | C2H_SPECIAL_STATISTICS_GET_DATA2(CmdBuf);
447 rtw_sctx_done(&pstapriv->gotc2h);
448 }
449 #ifdef CONFIG_FW_HANDLE_TXBCN
450 #define C2H_SUB_CMD_ID_FW_TBTT_RPT 0X23
451 #define TBTT_RPT_GET_SN(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X01, 0, 8)
452 #define TBTT_RPT_GET_PORT_ID(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 0, 8)
453
454 #define TBTT_ROOT 0x00
455 #define TBTT_VAP1 0x10
456 #define TBTT_VAP2 0x20
457 #define TBTT_VAP3 0x30
458
c2h_tbtt_rpt(PADAPTER adapter,u8 * pdata)459 static void c2h_tbtt_rpt(PADAPTER adapter, u8 *pdata)
460 {
461 u8 ap_id, c2h_sn;
462
463 ap_id = TBTT_RPT_GET_PORT_ID(pdata);
464 c2h_sn = TBTT_RPT_GET_SN(pdata);
465 #ifdef DBG_FW_TBTT_RPT
466 if (ap_id == TBTT_ROOT)
467 RTW_INFO("== TBTT ROOT SN:%d==\n", c2h_sn);
468 else if (ap_id == TBTT_VAP1)
469 RTW_INFO("== TBTT_VAP1 SN:%d==\n", c2h_sn);
470 else if (ap_id == TBTT_VAP2)
471 RTW_INFO("== TBTT_VAP2 SN:%d==\n", c2h_sn);
472 else if (ap_id == TBTT_VAP3)
473 RTW_INFO("== TBTT_VAP3 SN:%d==\n", c2h_sn);
474 else
475 RTW_ERR("TBTT RPT INFO ERROR\n");
476 #endif
477 }
478 #endif
479
480 #ifdef CONFIG_LPS_PWR_TRACKING
481 #define C2H_PKT_DETECT_THERMAL_GET_THERMAL_VALUE(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 0, 32)
482 #endif
483
484 /**
485 * c2h = RXDESC + c2h packet
486 * size = RXDESC_SIZE + c2h packet size
487 * c2h payload = c2h packet revmoe id & seq
488 */
process_c2h_event(PADAPTER adapter,u8 * c2h,u32 size)489 static void process_c2h_event(PADAPTER adapter, u8 *c2h, u32 size)
490 {
491 struct mlme_ext_priv *pmlmeext;
492 struct mlme_ext_info *pmlmeinfo;
493 u32 desc_size;
494 u8 id, seq;
495 u8 c2h_len, c2h_payload_len;
496 u8 *pc2h_data, *pc2h_payload;
497
498
499 if (!c2h) {
500 RTW_INFO("%s: c2h buffer is NULL!!\n", __FUNCTION__);
501 return;
502 }
503
504 desc_size = rtl8822b_get_rx_desc_size(adapter);
505
506 if (size < desc_size) {
507 RTW_INFO("%s: c2h length(%d) is smaller than RXDESC_SIZE(%d)!!\n",
508 __FUNCTION__, size, desc_size);
509 return;
510 }
511
512 pmlmeext = &adapter->mlmeextpriv;
513 pmlmeinfo = &pmlmeext->mlmext_info;
514
515 /* shift rx desc len */
516 pc2h_data = c2h + desc_size;
517 c2h_len = size - desc_size;
518
519 id = C2H_GET_CMD_ID(pc2h_data);
520 seq = C2H_GET_SEQ(pc2h_data);
521
522 /* shift 2 byte to remove cmd id & seq */
523 pc2h_payload = pc2h_data + 2;
524 c2h_payload_len = c2h_len - 2;
525
526 switch (id) {
527 #ifdef CONFIG_BEAMFORMING
528 case CMD_ID_C2H_SND_TXBF:
529 RTW_INFO("%s: [CMD_ID_C2H_SND_TXBF] len=%d\n", __FUNCTION__, c2h_payload_len);
530 rtw_bf_c2h_handler(adapter, id, pc2h_data, c2h_len);
531 break;
532 #endif /* CONFIG_BEAMFORMING */
533
534 case CMD_ID_C2H_AP_REQ_TXRPT:
535 /*RTW_INFO("[C2H], C2H_AP_REQ_TXRPT!!\n");*/
536 C2HTxRPTHandler_8822b(adapter, pc2h_data, c2h_len);
537 break;
538
539 case CMD_ID_C2H_SPECIAL_STATISTICS:
540 /*RTW_INFO("[C2H], C2H_SPC_STAT!!\n");*/
541 C2HSPC_STAT_8822b(adapter, pc2h_data, c2h_len);
542 break;
543
544 case CMD_ID_C2H_CUR_CHANNEL:
545 {
546 PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter);
547 struct submit_ctx *chsw_sctx = &hal->chsw_sctx;
548
549 /* RTW_INFO("[C2H], CMD_ID_C2H_CUR_CHANNEL!!\n"); */
550 rtw_sctx_done(&chsw_sctx);
551 break;
552 }
553
554 case C2H_EXTEND:
555 if (C2H_HDR_GET_C2H_SUB_CMD_ID(pc2h_data) == C2H_SUB_CMD_ID_CCX_RPT) {
556 /* Shift C2H HDR 4 bytes */
557 c2h_ccx_rpt(adapter, pc2h_data);
558 break;
559 }
560 #ifdef CONFIG_FW_HANDLE_TXBCN
561 else if (C2H_HDR_GET_C2H_SUB_CMD_ID(pc2h_data) == C2H_SUB_CMD_ID_FW_TBTT_RPT) {
562 c2h_tbtt_rpt(adapter, pc2h_data);
563 break;
564 }
565 #endif
566 #ifdef CONFIG_LPS_PWR_TRACKING
567 else if (C2H_HDR_GET_C2H_SUB_CMD_ID(pc2h_data) == C2H_SUB_CMD_ID_C2H_PKT_DETECT_THERMAL) {
568 u32 thermal = 0;
569
570 thermal = C2H_PKT_DETECT_THERMAL_GET_THERMAL_VALUE(pc2h_data);
571 if (1)
572 RTW_INFO("[C2H] FW Thermal report :0x%02x\n", thermal);
573 rtw_lps_pwr_tracking(adapter, thermal);
574 break;
575 }
576 #endif
577
578 /* indicate c2h pkt + rx desc to halmac */
579 rtw_halmac_c2h_handle(adapter_to_dvobj(adapter), c2h, size);
580 break;
581
582 /* others for c2h common code */
583 default:
584 c2h_handler(adapter, id, seq, c2h_payload_len, pc2h_payload);
585 break;
586 }
587 }
588
rtl8822b_c2h_handler(PADAPTER adapter,u8 * pbuf,u16 length)589 void rtl8822b_c2h_handler(PADAPTER adapter, u8 *pbuf, u16 length)
590 {
591 #ifdef CONFIG_WOWLAN
592 struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter);
593
594
595 if (pwrpriv->wowlan_mode == _TRUE) {
596 #ifdef CONFIG_RTW_DEBUG
597 u32 desc_size;
598
599 desc_size = rtl8822b_get_rx_desc_size(adapter);
600 RTW_INFO("%s: return because wowolan_mode==TRUE! CMDID=%d\n",
601 __FUNCTION__, C2H_GET_CMD_ID(pbuf + desc_size));
602 #endif /* CONFIG_RTW_DEBUG */
603 return;
604 }
605 #endif /* CONFIG_WOWLAN*/
606
607 process_c2h_event(adapter, pbuf, length);
608 }
609
610 /**
611 * pbuf = RXDESC + c2h packet
612 * length = RXDESC_SIZE + c2h packet size
613 */
rtl8822b_c2h_handler_no_io(PADAPTER adapter,u8 * pbuf,u16 length)614 void rtl8822b_c2h_handler_no_io(PADAPTER adapter, u8 *pbuf, u16 length)
615 {
616 u32 desc_size;
617 u8 id, seq;
618 u8 *pc2h_content;
619 u8 res;
620
621
622 if ((length == 0) || (!pbuf))
623 return;
624
625 desc_size = rtl8822b_get_rx_desc_size(adapter);
626
627 /* shift rx desc len to get c2h packet content */
628 pc2h_content = pbuf + desc_size;
629 id = C2H_GET_CMD_ID(pc2h_content);
630 seq = C2H_GET_SEQ(pc2h_content);
631
632 RTW_DBG("%s: C2H, ID=%d seq=%d len=%d\n",
633 __FUNCTION__, id, seq, length);
634
635 switch (id) {
636 case CMD_ID_C2H_SND_TXBF:
637 case CMD_ID_C2H_CCX_RPT:
638 case C2H_BT_MP_INFO:
639 case C2H_FW_CHNL_SWITCH_COMPLETE:
640 case C2H_IQK_FINISH:
641 case C2H_MCC:
642 case C2H_BCN_EARLY_RPT:
643 case C2H_LPS_STATUS_RPT:
644 case C2H_EXTEND:
645 /* no I/O, process directly */
646 #ifdef CONFIG_LPS_PWR_TRACKING
647 if (id == C2H_EXTEND &&
648 C2H_HDR_GET_C2H_SUB_CMD_ID(pc2h_content) == C2H_SUB_CMD_ID_C2H_PKT_DETECT_THERMAL)
649 rtw_c2h_packet_wk_cmd(adapter, pbuf, length);
650 else
651 #endif
652 process_c2h_event(adapter, pbuf, length);
653 break;
654
655 default:
656 /* Others may need I/O, run in command thread */
657 res = rtw_c2h_packet_wk_cmd(adapter, pbuf, length);
658 if (res == _FAIL)
659 RTW_ERR("%s: C2H(%d) enqueue FAIL!\n", __FUNCTION__, id);
660 break;
661 }
662 }
663