1 /******************************************************************************
2 *
3 * Copyright(c) 2016 - 2017 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 _RTL8821C_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 "rtl8821c.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 ******************************************/
rtl8821c_fillh2ccmd(PADAPTER adapter,u8 id,u32 buf_len,u8 * pbuf)32 s32 rtl8821c_fillh2ccmd(PADAPTER adapter, u8 id, u32 buf_len, u8 *pbuf)
33 {
34 u8 h2c[RTW_HALMAC_H2C_MAX_SIZE] = {0};
35 #ifdef DBG_H2C_CONTENT
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 DBG_H2C_CONTENT
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_INFO(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
79 #define SET_PWR_MODE_SET_BCN_RECEIVING_TIME(h2c_pkt, value) \
80 SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 24, 5, value)
81 #define SET_PWR_MODE_SET_ADOPT_BCN_RECEIVING_TIME(h2c_pkt, value) \
82 SET_BITS_TO_LE_4BYTE(h2c_pkt + 0X04, 31, 1, value)
83
_rtl8821c_set_FwPwrMode_cmd(PADAPTER adapter,u8 psmode,u8 rfon_ctrl)84 void _rtl8821c_set_FwPwrMode_cmd(PADAPTER adapter, u8 psmode, u8 rfon_ctrl)
85 {
86 u8 mode = 0, smart_ps = 0;
87 struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter);
88 #ifdef CONFIG_BCN_RECV_TIME
89 u8 bcn_recv_time;
90 struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv;
91 #endif
92 #ifdef CONFIG_WMMPS_STA
93 struct mlme_priv *pmlmepriv = &(adapter->mlmepriv);
94 struct qos_priv *pqospriv = &pmlmepriv->qospriv;
95 #endif /* CONFIG_WMMPS_STA */
96 u8 h2c[RTW_HALMAC_H2C_MAX_SIZE] = {0};
97 u8 PowerState = 0, awake_intvl = 1, rlbm = 0;
98 u8 allQueueUAPSD = 0;
99 char *fw_psmode_str = "UNSPECIFIED";
100 #ifdef CONFIG_P2P
101 struct wifidirect_info *wdinfo = &adapter->wdinfo;
102 #endif /* CONFIG_P2P */
103 u8 hw_port = rtw_hal_get_port(adapter);
104
105 if (pwrpriv->pwr_mode != psmode) {
106 if (pwrpriv->dtim > 0)
107 RTW_INFO(FUNC_ADPT_FMT ": dtim=%d, HW port id=%d\n", FUNC_ADPT_ARG(adapter),
108 pwrpriv->dtim, psmode == PS_MODE_ACTIVE ? pwrpriv->current_lps_hw_port_id : hw_port);
109 else
110 RTW_INFO(FUNC_ADPT_FMT ": HW port id=%d\n", FUNC_ADPT_ARG(adapter),
111 psmode == PS_MODE_ACTIVE ? pwrpriv->current_lps_hw_port_id : hw_port);
112 }
113
114 smart_ps = pwrpriv->smart_ps;
115 switch (psmode) {
116 case PS_MODE_MIN:
117 case PS_MODE_MAX:
118 {
119 #ifdef CONFIG_WMMPS_STA
120 if (rtw_is_wmmps_mode(adapter)) {
121 mode = 2;
122
123 smart_ps = pwrpriv->wmm_smart_ps;
124
125 /* (WMMPS) allQueueUAPSD: 0: PSPoll, 1: QosNullData (if wmm_smart_ps=1) or do nothing (if wmm_smart_ps=2) */
126 if ((pqospriv->uapsd_tid & BIT_MASK_TID_TC) == ALL_TID_TC_SUPPORTED_UAPSD)
127 allQueueUAPSD = 1;
128 } else
129 #endif /* CONFIG_WMMPS_STA */
130 {
131 mode = 1;
132 #ifdef CONFIG_WMMPS_STA
133 /* For WMMPS test case, the station must retain sleep mode to capture buffered data on LPS mechanism */
134 if ((pqospriv->uapsd_tid & BIT_MASK_TID_TC) != 0)
135 smart_ps = 0;
136 else
137 #endif /* CONFIG_WMMPS_STA */
138 {
139 smart_ps = pwrpriv->smart_ps;
140 }
141 }
142
143 if (psmode == PS_MODE_MIN)
144 rlbm = 0;
145 else
146 rlbm = 1;
147 }
148 break;
149 case PS_MODE_DTIM:
150 {
151 mode = 1;
152 rlbm = 2;
153
154 /* For WOWLAN LPS, DTIM = (awake_intvl - 1) */
155 if (pwrpriv->dtim > 0 && pwrpriv->dtim < 16) /* DTIM = (awake_intvl - 1) */
156 awake_intvl = pwrpriv->dtim + 1;
157 else /* DTIM = 3 */
158 awake_intvl = 4;
159 }
160 break;
161 case PS_MODE_ACTIVE:
162 default:
163 mode = 0;
164 break;
165 }
166
167 #ifdef CONFIG_P2P
168 if (!rtw_p2p_chk_state(wdinfo, P2P_STATE_NONE)) {
169 awake_intvl = 2;
170 rlbm = 1;
171 }
172 #endif /* CONFIG_P2P */
173
174 if (adapter->registrypriv.wifi_spec == 1) {
175 awake_intvl = 2;
176 rlbm = 1;
177 }
178
179 if (psmode > 0) {
180 #ifdef CONFIG_BT_COEXIST
181 if (rtw_btcoex_IsBtControlLps(adapter) == _TRUE)
182 PowerState = rtw_btcoex_RpwmVal(adapter);
183 else
184 #endif /* CONFIG_BT_COEXIST */
185 {
186 if (rfon_ctrl == rf_on)
187 PowerState = 0x04; /* AllON(0x0C), RFON(0x04), RFOFF(0x00) */
188 else
189 PowerState = 0x00; /* AllON(0x0C), RFON(0x04), RFOFF(0x00) */
190 }
191 } else
192 PowerState = 0x0C; /* AllON(0x0C), RFON(0x04), RFOFF(0x00) */
193
194 if (pwrpriv->pwr_mode != psmode) {
195 if (mode == 0)
196 fw_psmode_str = "ACTIVE";
197 else if (mode == 1)
198 fw_psmode_str = "LPS";
199 else if (mode == 2)
200 fw_psmode_str = "WMMPS";
201
202 RTW_INFO(FUNC_ADPT_FMT": fw ps mode = %s, drv ps mode = %d, rlbm = %d ,"
203 "smart_ps = %d, allQueueUAPSD = %d, PowerState = %d\n",
204 FUNC_ADPT_ARG(adapter), fw_psmode_str, psmode, rlbm, smart_ps,
205 allQueueUAPSD, PowerState);
206 }
207
208 SET_PWR_MODE_SET_CMD_ID(h2c, CMD_ID_SET_PWR_MODE);
209 SET_PWR_MODE_SET_CLASS(h2c, CLASS_SET_PWR_MODE);
210 SET_PWR_MODE_SET_MODE(h2c, mode);
211 SET_PWR_MODE_SET_SMART_PS(h2c, smart_ps);
212 SET_PWR_MODE_SET_RLBM(h2c, rlbm);
213 SET_PWR_MODE_SET_AWAKE_INTERVAL(h2c, awake_intvl);
214 SET_PWR_MODE_SET_B_ALL_QUEUE_UAPSD(h2c, allQueueUAPSD);
215 SET_PWR_MODE_SET_PWR_STATE(h2c, PowerState);
216 if (psmode == PS_MODE_ACTIVE) {
217 /* Leave LPS, set the same HW port ID */
218 SET_PWR_MODE_SET_PORT_ID(h2c, pwrpriv->current_lps_hw_port_id);
219 } else {
220 /* Enter LPS, record HW port ID */
221 SET_PWR_MODE_SET_PORT_ID(h2c, hw_port);
222 pwrpriv->current_lps_hw_port_id = hw_port;
223 }
224
225 #ifdef CONFIG_BCN_RECV_TIME
226 if (pmlmeext->bcn_rx_time) {
227 bcn_recv_time = pmlmeext->bcn_rx_time / 128;
228 if (pmlmeext->bcn_rx_time % 128)
229 bcn_recv_time += 1;
230
231 if (bcn_recv_time >= 31)
232 bcn_recv_time = 31;
233 SET_PWR_MODE_SET_ADOPT_BCN_RECEIVING_TIME(h2c, 1);
234 SET_PWR_MODE_SET_BCN_RECEIVING_TIME(h2c, bcn_recv_time);
235 }
236 #endif
237
238 RTW_INFO("%s=> psmode:%02x, smart_ps:%02x, PowerState:%02x\n", __func__, psmode, smart_ps, PowerState);
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
rtl8821c_set_FwPwrMode_cmd(PADAPTER adapter,u8 psmode)248 void rtl8821c_set_FwPwrMode_cmd(PADAPTER adapter, u8 psmode)
249 {
250 return _rtl8821c_set_FwPwrMode_cmd(adapter, psmode, rf_off);
251 }
252
rtl8821c_set_FwPwrMode_rfon_ctrl_cmd(PADAPTER adapter,u8 rfon_ctrl)253 void rtl8821c_set_FwPwrMode_rfon_ctrl_cmd(PADAPTER adapter, u8 rfon_ctrl)
254 {
255 struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter);
256
257 return _rtl8821c_set_FwPwrMode_cmd(adapter, pwrpriv->power_mgnt, rfon_ctrl);
258 }
259
rtl8821c_set_FwPwrModeInIPS_cmd(PADAPTER adapter,u8 cmd_param)260 void rtl8821c_set_FwPwrModeInIPS_cmd(PADAPTER adapter, u8 cmd_param)
261 {
262 u8 h2c[RTW_HALMAC_H2C_MAX_SIZE] = {0};
263
264 INACTIVE_PS_SET_CMD_ID(h2c, CMD_ID_INACTIVE_PS);
265 INACTIVE_PS_SET_CLASS(h2c, CLASS_INACTIVE_PS);
266
267 if (cmd_param & BIT0)
268 INACTIVE_PS_SET_ENABLE(h2c, 1);
269 if (cmd_param & BIT1)
270 INACTIVE_PS_SET_IGNORE_PS_CONDITION(h2c, 1);
271
272 RTW_DBG_DUMP("FW_IPS Parm:", h2c, RTW_HALMAC_H2C_MAX_SIZE);
273 rtw_halmac_send_h2c(adapter_to_dvobj(adapter), h2c);
274 }
275
276 #ifdef CONFIG_WOWLAN
rtl8821c_set_fw_pwrmode_inips_cmd_wowlan(PADAPTER padapter,u8 ps_mode)277 void rtl8821c_set_fw_pwrmode_inips_cmd_wowlan(PADAPTER padapter, u8 ps_mode)
278 {
279 struct registry_priv *registry_par = &padapter->registrypriv;
280 u8 param[H2C_INACTIVE_PS_LEN] = {0};
281 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
282
283 RTW_INFO("%s, ps_mode: %d\n", __func__, ps_mode);
284 if (ps_mode == PS_MODE_ACTIVE) {
285 SET_H2CCMD_INACTIVE_PS_EN(param, 0);
286 }
287 else {
288 SET_H2CCMD_INACTIVE_PS_EN(param, 1);
289 if(registry_par->suspend_type == FW_IPS_DISABLE_BBRF && !check_fwstate(pmlmepriv, WIFI_ASOC_STATE))
290 SET_H2CCMD_INACTIVE_DISBBRF(param, 1);
291 if(registry_par->suspend_type == FW_IPS_WRC) {
292 SET_H2CCMD_INACTIVE_PERIOD_SCAN_EN(param, 1);
293 SET_H2CCMD_INACTIVE_PS_FREQ(param, 3);
294 SET_H2CCMD_INACTIVE_PS_DURATION(param, 1);
295 SET_H2CCMD_INACTIVE_PS_PERIOD_SCAN_TIME(param, 3);
296 }
297 }
298
299 rtl8821c_fillh2ccmd(padapter, H2C_INACTIVE_PS_, sizeof(param), param);
300 }
301 #endif /* CONFIG_WOWLAN */
302
303 #ifdef CONFIG_BT_COEXIST
rtl8821c_download_BTCoex_AP_mode_rsvd_page(PADAPTER adapter)304 void rtl8821c_download_BTCoex_AP_mode_rsvd_page(PADAPTER adapter)
305 {
306 rtl8821c_dl_rsvd_page(adapter, RT_MEDIA_CONNECT);
307 }
308 #endif /* CONFIG_BT_COEXIST */
309
310 /*
311 * Below functions are for C2H
312 */
c2h_ccx_rpt(PADAPTER adapter,u8 * pdata)313 static void c2h_ccx_rpt(PADAPTER adapter, u8 *pdata)
314 {
315 #ifdef CONFIG_XMIT_ACK
316 u8 tx_state;
317
318 tx_state = CCX_RPT_GET_TX_STATE(pdata);
319
320 /* 0 means success, 1 means retry drop */
321 if (tx_state == 0)
322 rtw_ack_tx_done(&adapter->xmitpriv, RTW_SCTX_DONE_SUCCESS);
323 else
324 rtw_ack_tx_done(&adapter->xmitpriv, RTW_SCTX_DONE_CCX_PKT_FAIL);
325 #endif /* CONFIG_XMIT_ACK */
326 }
327 #ifdef CONFIG_FW_HANDLE_TXBCN
328 #define C2H_SUB_CMD_ID_FW_TBTT_RPT 0X23
329 #define TBTT_RPT_GET_SN(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X01, 0, 8)
330 #define TBTT_RPT_GET_PORT_ID(c2h_pkt) LE_BITS_TO_4BYTE(c2h_pkt + 0X04, 0, 8)
331
332 #define TBTT_ROOT 0x00
333 #define TBTT_VAP1 0x10
334 #define TBTT_VAP2 0x20
335 #define TBTT_VAP3 0x30
336
c2h_tbtt_rpt(PADAPTER adapter,u8 * pdata)337 static void c2h_tbtt_rpt(PADAPTER adapter, u8 *pdata)
338 {
339 u8 ap_id, c2h_sn;
340
341 ap_id = TBTT_RPT_GET_PORT_ID(pdata);
342 c2h_sn = TBTT_RPT_GET_SN(pdata);
343 #ifdef DBG_FW_TBTT_RPT
344 if (ap_id == TBTT_ROOT)
345 RTW_INFO("== TBTT ROOT SN:%d==\n", c2h_sn);
346 else if (ap_id == TBTT_VAP1)
347 RTW_INFO("== TBTT_VAP1 SN:%d==\n", c2h_sn);
348 else if (ap_id == TBTT_VAP2)
349 RTW_INFO("== TBTT_VAP2 SN:%d==\n", c2h_sn);
350 else if (ap_id == TBTT_VAP3)
351 RTW_INFO("== TBTT_VAP3 SN:%d==\n", c2h_sn);
352 else
353 RTW_ERR("TBTT RPT INFO ERROR\n");
354 #endif
355 }
356 #endif
357
358 /**
359 * pbuf = RXDESC + c2h packet
360 * length = RXDESC_SIZE + c2h packet size
361 * c2h format => ID(1B) | SN(1B) | Payload
362 * C2H - 0xFF format
363 * u8 CMD_ID
364 * u8 CMD_SEQ
365 * u8 SUB_CMD_ID
366 * u8 CMD_LEN
367 * u8 *pContent
368 */
c2h_handler_rtl8821c(PADAPTER adapter,u8 * pbuf,u16 length)369 void c2h_handler_rtl8821c(PADAPTER adapter, u8 *pbuf, u16 length)
370 {
371 u8 c2h_id, c2h_sn;
372 int c2h_len;
373 u8 *pc2h_hdr;
374 u8 *pc2h_data;
375 u8 c2h_sub_cmd_id = 0;
376 u32 desc_size = 0;
377 #ifdef CONFIG_WOWLAN
378 struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter);
379 #endif /* CONFIG_WOWLAN*/
380
381 rtw_halmac_get_rx_desc_size(adapter_to_dvobj(adapter), &desc_size);
382
383 #ifdef CONFIG_WOWLAN
384 if (pwrpriv->wowlan_mode == _TRUE) {
385 RTW_INFO("%s: return because wowolan_mode==TRUE! CMDID=%d\n",
386 __FUNCTION__, C2H_GET_CMD_ID(pbuf + desc_size));
387 return;
388 }
389 #endif /* CONFIG_WOWLAN*/
390 if (pbuf == NULL)
391 return;
392
393 if (length < desc_size) {
394 RTW_INFO("%s: [ERROR] c2h length(%d) is smaller than RXDESC_SIZE(%d)!!\n",
395 __func__, length, desc_size);
396 return;
397 }
398
399 pc2h_hdr = pbuf + desc_size;
400 pc2h_data = pbuf + desc_size + 2; /* cmd ID not 0xFF original C2H have 2 bytes C2H header */
401 c2h_id = C2H_GET_CMD_ID(pc2h_hdr);
402 c2h_sn = C2H_GET_SEQ(pc2h_hdr);
403 c2h_len = length - desc_size - 2;
404
405 if (c2h_len < 0) {
406 RTW_ERR("%s: [ERROR] C2H_ID(%02x) C2H_SN(%d) warn c2h_len :%d (length:%d)\n", __func__, c2h_id, c2h_sn, c2h_len, length);
407 rtw_warn_on(1);
408 return;
409 }
410 #ifdef DBG_C2H_CONTENT
411 RTW_INFO("%s "ADPT_FMT" C2H, ID=%d seq=%d len=%d\n", __func__, ADPT_ARG(adapter), c2h_id, c2h_sn, length);
412 #endif
413 switch (c2h_id) {
414 case CMD_ID_C2H_SND_TXBF:
415 /*C2HTxBeamformingHandler_8821C(adapter, pc2h_data, c2h_len);*/
416 break;
417
418 /* FW offload C2H is 0xFF cmd according to halmac function - halmac_parse_c2h_packet */
419 case 0xFF:
420 /* Get C2H sub cmd ID */
421 c2h_sub_cmd_id = (u8)C2H_HDR_GET_C2H_SUB_CMD_ID(pc2h_hdr);
422 if (c2h_sub_cmd_id == C2H_SUB_CMD_ID_CCX_RPT)
423 c2h_ccx_rpt(adapter, pbuf + desc_size);
424 #ifdef CONFIG_FW_HANDLE_TXBCN
425 else if (c2h_sub_cmd_id == C2H_SUB_CMD_ID_FW_TBTT_RPT)
426 c2h_tbtt_rpt(adapter, pbuf + desc_size);
427 #endif
428 else
429 /* indicate rx desc + c2h pkt to halmac */
430 if (rtw_halmac_c2h_handle(adapter_to_dvobj(adapter), pbuf, length) == -1)
431 RTW_ERR("%s "ADPT_FMT" C2H, ID=%d, SubID=%d seq=%d len=%d ,HALMAC not to handle\n",
432 __func__, ADPT_ARG(adapter), c2h_id, c2h_sub_cmd_id, c2h_sn, length);
433 break;
434 /* others for c2h common code */
435 default:
436 /* shift 2 byte to remove cmd id & seq */
437 c2h_handler(adapter, c2h_id, c2h_sn, c2h_len, pc2h_data);
438 break;
439 }
440 }
441
442
is_c2h_id_handle_directly(u8 c2h_id,u8 c2h_sub_cmd_id)443 static inline u8 is_c2h_id_handle_directly(u8 c2h_id, u8 c2h_sub_cmd_id)
444 {
445 switch (c2h_id) {
446 case CMD_ID_C2H_CCX_RPT:
447 case C2H_IQK_FINISH:
448 case C2H_EXTEND:
449
450 #if defined(CONFIG_TDLS) && defined(CONFIG_TDLS_CH_SW)
451 case C2H_BCN_EARLY_RPT:
452 case C2H_FW_CHNL_SWITCH_COMPLETE:
453 #endif
454
455 #ifdef CONFIG_BT_COEXIST
456 case C2H_BT_MP_INFO:
457 #endif
458
459 #ifdef CONFIG_MCC_MODE
460 case C2H_MCC:
461 #endif
462 case C2H_LPS_STATUS_RPT:
463 return _TRUE;
464 default:
465 return _FALSE;
466 }
467
468 }
469
470 /*
471 * pbuf = RXDESC + c2h packet
472 * length = RXDESC_SIZE + c2h packet size
473 */
c2h_pre_handler_rtl8821c(_adapter * adapter,u8 * pbuf,s32 length)474 void c2h_pre_handler_rtl8821c(_adapter *adapter, u8 *pbuf, s32 length)
475 {
476 u8 c2h_id;
477 u8 c2h_sub_cmd_id = 0;
478 u32 desc_size = 0;
479
480 if ((length <= 0) || (!pbuf))
481 return;
482
483 rtw_halmac_get_rx_desc_size(adapter_to_dvobj(adapter), &desc_size);
484
485 c2h_id = C2H_GET_CMD_ID(pbuf + desc_size);
486
487 /* Get C2H sub cmd ID */
488 if (c2h_id == 0xFF)
489 c2h_sub_cmd_id = (u8)C2H_HDR_GET_C2H_SUB_CMD_ID(pbuf + desc_size);
490
491 if (is_c2h_id_handle_directly(c2h_id, c2h_sub_cmd_id))
492 c2h_handler_rtl8821c(adapter, pbuf, length);
493 else
494 rtw_c2h_packet_wk_cmd(adapter, pbuf, length);
495 }
496