158391efdSNathan Chancellor // SPDX-License-Identifier: GPL-2.0
2554c0a3aSHans de Goede /******************************************************************************
3554c0a3aSHans de Goede *
4554c0a3aSHans de Goede * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved.
5554c0a3aSHans de Goede *
6554c0a3aSHans de Goede ******************************************************************************/
7554c0a3aSHans de Goede #include <drv_types.h>
8554c0a3aSHans de Goede #include <rtw_debug.h>
9800132aaSNishka Dasgupta #include <hal_btcoex.h>
10554c0a3aSHans de Goede #include <linux/jiffies.h>
11554c0a3aSHans de Goede
12554c0a3aSHans de Goede static struct _cmd_callback rtw_cmd_callback[] = {
13554c0a3aSHans de Goede {GEN_CMD_CODE(_Read_MACREG), NULL}, /*0*/
14554c0a3aSHans de Goede {GEN_CMD_CODE(_Write_MACREG), NULL},
15554c0a3aSHans de Goede {GEN_CMD_CODE(_Read_BBREG), &rtw_getbbrfreg_cmdrsp_callback},
16554c0a3aSHans de Goede {GEN_CMD_CODE(_Write_BBREG), NULL},
17554c0a3aSHans de Goede {GEN_CMD_CODE(_Read_RFREG), &rtw_getbbrfreg_cmdrsp_callback},
18554c0a3aSHans de Goede {GEN_CMD_CODE(_Write_RFREG), NULL}, /*5*/
19554c0a3aSHans de Goede {GEN_CMD_CODE(_Read_EEPROM), NULL},
20554c0a3aSHans de Goede {GEN_CMD_CODE(_Write_EEPROM), NULL},
21554c0a3aSHans de Goede {GEN_CMD_CODE(_Read_EFUSE), NULL},
22554c0a3aSHans de Goede {GEN_CMD_CODE(_Write_EFUSE), NULL},
23554c0a3aSHans de Goede
24554c0a3aSHans de Goede {GEN_CMD_CODE(_Read_CAM), NULL}, /*10*/
25554c0a3aSHans de Goede {GEN_CMD_CODE(_Write_CAM), NULL},
26554c0a3aSHans de Goede {GEN_CMD_CODE(_setBCNITV), NULL},
27554c0a3aSHans de Goede {GEN_CMD_CODE(_setMBIDCFG), NULL},
28554c0a3aSHans de Goede {GEN_CMD_CODE(_JoinBss), &rtw_joinbss_cmd_callback}, /*14*/
29554c0a3aSHans de Goede {GEN_CMD_CODE(_DisConnect), &rtw_disassoc_cmd_callback}, /*15*/
30554c0a3aSHans de Goede {GEN_CMD_CODE(_CreateBss), &rtw_createbss_cmd_callback},
31554c0a3aSHans de Goede {GEN_CMD_CODE(_SetOpMode), NULL},
32554c0a3aSHans de Goede {GEN_CMD_CODE(_SiteSurvey), &rtw_survey_cmd_callback}, /*18*/
33554c0a3aSHans de Goede {GEN_CMD_CODE(_SetAuth), NULL},
34554c0a3aSHans de Goede
35554c0a3aSHans de Goede {GEN_CMD_CODE(_SetKey), NULL}, /*20*/
36554c0a3aSHans de Goede {GEN_CMD_CODE(_SetStaKey), &rtw_setstaKey_cmdrsp_callback},
37554c0a3aSHans de Goede {GEN_CMD_CODE(_SetAssocSta), &rtw_setassocsta_cmdrsp_callback},
38554c0a3aSHans de Goede {GEN_CMD_CODE(_DelAssocSta), NULL},
39554c0a3aSHans de Goede {GEN_CMD_CODE(_SetStaPwrState), NULL},
40554c0a3aSHans de Goede {GEN_CMD_CODE(_SetBasicRate), NULL}, /*25*/
41554c0a3aSHans de Goede {GEN_CMD_CODE(_GetBasicRate), NULL},
42554c0a3aSHans de Goede {GEN_CMD_CODE(_SetDataRate), NULL},
43554c0a3aSHans de Goede {GEN_CMD_CODE(_GetDataRate), NULL},
44554c0a3aSHans de Goede {GEN_CMD_CODE(_SetPhyInfo), NULL},
45554c0a3aSHans de Goede
46554c0a3aSHans de Goede {GEN_CMD_CODE(_GetPhyInfo), NULL}, /*30*/
47554c0a3aSHans de Goede {GEN_CMD_CODE(_SetPhy), NULL},
48554c0a3aSHans de Goede {GEN_CMD_CODE(_GetPhy), NULL},
49554c0a3aSHans de Goede {GEN_CMD_CODE(_readRssi), NULL},
50554c0a3aSHans de Goede {GEN_CMD_CODE(_readGain), NULL},
51554c0a3aSHans de Goede {GEN_CMD_CODE(_SetAtim), NULL}, /*35*/
52554c0a3aSHans de Goede {GEN_CMD_CODE(_SetPwrMode), NULL},
53554c0a3aSHans de Goede {GEN_CMD_CODE(_JoinbssRpt), NULL},
54554c0a3aSHans de Goede {GEN_CMD_CODE(_SetRaTable), NULL},
55554c0a3aSHans de Goede {GEN_CMD_CODE(_GetRaTable), NULL},
56554c0a3aSHans de Goede
57554c0a3aSHans de Goede {GEN_CMD_CODE(_GetCCXReport), NULL}, /*40*/
58554c0a3aSHans de Goede {GEN_CMD_CODE(_GetDTMReport), NULL},
59554c0a3aSHans de Goede {GEN_CMD_CODE(_GetTXRateStatistics), NULL},
60554c0a3aSHans de Goede {GEN_CMD_CODE(_SetUsbSuspend), NULL},
61554c0a3aSHans de Goede {GEN_CMD_CODE(_SetH2cLbk), NULL},
62554c0a3aSHans de Goede {GEN_CMD_CODE(_AddBAReq), NULL}, /*45*/
63554c0a3aSHans de Goede {GEN_CMD_CODE(_SetChannel), NULL}, /*46*/
64554c0a3aSHans de Goede {GEN_CMD_CODE(_SetTxPower), NULL},
65554c0a3aSHans de Goede {GEN_CMD_CODE(_SwitchAntenna), NULL},
66554c0a3aSHans de Goede {GEN_CMD_CODE(_SetCrystalCap), NULL},
67554c0a3aSHans de Goede {GEN_CMD_CODE(_SetSingleCarrierTx), NULL}, /*50*/
68554c0a3aSHans de Goede
69554c0a3aSHans de Goede {GEN_CMD_CODE(_SetSingleToneTx), NULL}, /*51*/
70554c0a3aSHans de Goede {GEN_CMD_CODE(_SetCarrierSuppressionTx), NULL},
71554c0a3aSHans de Goede {GEN_CMD_CODE(_SetContinuousTx), NULL},
72554c0a3aSHans de Goede {GEN_CMD_CODE(_SwitchBandwidth), NULL}, /*54*/
73554c0a3aSHans de Goede {GEN_CMD_CODE(_TX_Beacon), NULL},/*55*/
74554c0a3aSHans de Goede
75554c0a3aSHans de Goede {GEN_CMD_CODE(_Set_MLME_EVT), NULL},/*56*/
76554c0a3aSHans de Goede {GEN_CMD_CODE(_Set_Drv_Extra), NULL},/*57*/
77554c0a3aSHans de Goede {GEN_CMD_CODE(_Set_H2C_MSG), NULL},/*58*/
78554c0a3aSHans de Goede {GEN_CMD_CODE(_SetChannelPlan), NULL},/*59*/
79554c0a3aSHans de Goede
8071d3edc6SFabio M. De Francesco {GEN_CMD_CODE(_SetChannelSwitch), NULL},/*60*/
8171d3edc6SFabio M. De Francesco {GEN_CMD_CODE(_TDLS), NULL},/*61*/
8271d3edc6SFabio M. De Francesco {GEN_CMD_CODE(_ChkBMCSleepq), NULL}, /*62*/
83554c0a3aSHans de Goede
8471d3edc6SFabio M. De Francesco {GEN_CMD_CODE(_RunInThreadCMD), NULL},/*63*/
85554c0a3aSHans de Goede };
86554c0a3aSHans de Goede
87554c0a3aSHans de Goede static struct cmd_hdl wlancmds[] = {
88554c0a3aSHans de Goede GEN_DRV_CMD_HANDLER(0, NULL) /*0*/
89554c0a3aSHans de Goede GEN_DRV_CMD_HANDLER(0, NULL)
90554c0a3aSHans de Goede GEN_DRV_CMD_HANDLER(0, NULL)
91554c0a3aSHans de Goede GEN_DRV_CMD_HANDLER(0, NULL)
92554c0a3aSHans de Goede GEN_DRV_CMD_HANDLER(0, NULL)
93554c0a3aSHans de Goede GEN_DRV_CMD_HANDLER(0, NULL)
94554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(0, NULL)
95554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(0, NULL)
96554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(0, NULL)
97554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(0, NULL)
98554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(0, NULL) /*10*/
99554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(0, NULL)
100554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(0, NULL)
101554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(0, NULL)
102554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(sizeof(struct joinbss_parm), join_cmd_hdl) /*14*/
103554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(sizeof(struct disconnect_parm), disconnect_hdl)
104554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(sizeof(struct createbss_parm), createbss_hdl)
105554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(sizeof(struct setopmode_parm), setopmode_hdl)
106554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(sizeof(struct sitesurvey_parm), sitesurvey_cmd_hdl) /*18*/
107554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(sizeof(struct setauth_parm), setauth_hdl)
108554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(sizeof(struct setkey_parm), setkey_hdl) /*20*/
109554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(sizeof(struct set_stakey_parm), set_stakey_hdl)
110554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(sizeof(struct set_assocsta_parm), NULL)
111554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(sizeof(struct del_assocsta_parm), NULL)
112554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(sizeof(struct setstapwrstate_parm), NULL)
113554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(sizeof(struct setbasicrate_parm), NULL)
114554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(sizeof(struct getbasicrate_parm), NULL)
115554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(sizeof(struct setdatarate_parm), NULL)
116554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(sizeof(struct getdatarate_parm), NULL)
117554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(sizeof(struct setphyinfo_parm), NULL)
118554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(sizeof(struct getphyinfo_parm), NULL) /*30*/
119554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(sizeof(struct setphy_parm), NULL)
120554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(sizeof(struct getphy_parm), NULL)
121554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(0, NULL)
122554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(0, NULL)
123554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(0, NULL)
124554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(0, NULL)
125554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(0, NULL)
126554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(0, NULL)
127554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(0, NULL)
128554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(0, NULL) /*40*/
129554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(0, NULL)
130554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(0, NULL)
131554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(0, NULL)
132554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(0, NULL)
133554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(sizeof(struct addBaReq_parm), add_ba_hdl)
134554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(sizeof(struct set_ch_parm), set_ch_hdl) /* 46 */
135554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(0, NULL)
136554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(0, NULL)
137554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(0, NULL)
138554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(0, NULL) /*50*/
139554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(0, NULL)
140554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(0, NULL)
141554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(0, NULL)
142554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(0, NULL)
143554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(sizeof(struct Tx_Beacon_param), tx_beacon_hdl) /*55*/
144554c0a3aSHans de Goede
145554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(0, mlme_evt_hdl) /*56*/
146554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(0, rtw_drvextra_cmd_hdl) /*57*/
147554c0a3aSHans de Goede
148554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(0, h2c_msg_hdl) /*58*/
149554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(sizeof(struct SetChannelPlan_param), set_chplan_hdl) /*59*/
150554c0a3aSHans de Goede
15171d3edc6SFabio M. De Francesco GEN_MLME_EXT_HANDLER(sizeof(struct SetChannelSwitch_param), set_csa_hdl) /*60*/
15271d3edc6SFabio M. De Francesco GEN_MLME_EXT_HANDLER(sizeof(struct TDLSoption_param), tdls_hdl) /*61*/
15371d3edc6SFabio M. De Francesco GEN_MLME_EXT_HANDLER(0, chk_bmc_sleepq_hdl) /*62*/
154554c0a3aSHans de Goede GEN_MLME_EXT_HANDLER(sizeof(struct RunInThread_param), run_in_thread_hdl) /*63*/
155554c0a3aSHans de Goede };
156554c0a3aSHans de Goede
157554c0a3aSHans de Goede /*
158c57f4f00SPhilippe Dixon * Caller and the rtw_cmd_thread can protect cmd_q by spin_lock.
159c57f4f00SPhilippe Dixon * No irqsave is necessary.
160554c0a3aSHans de Goede */
161554c0a3aSHans de Goede
rtw_init_cmd_priv(struct cmd_priv * pcmdpriv)162b1c30bd6SMadhumitha Prabakaran int rtw_init_cmd_priv(struct cmd_priv *pcmdpriv)
163554c0a3aSHans de Goede {
16409a8ea34SArnd Bergmann init_completion(&pcmdpriv->cmd_queue_comp);
16509a8ea34SArnd Bergmann init_completion(&pcmdpriv->terminate_cmdthread_comp);
166554c0a3aSHans de Goede
1676c3ec1e2SFabio Aiuto INIT_LIST_HEAD(&pcmdpriv->cmd_queue.queue);
1686c3ec1e2SFabio Aiuto spin_lock_init(&pcmdpriv->cmd_queue.lock);
169554c0a3aSHans de Goede
170554c0a3aSHans de Goede /* allocate DMA-able/Non-Page memory for cmd_buf and rsp_buf */
171554c0a3aSHans de Goede
172554c0a3aSHans de Goede pcmdpriv->cmd_seq = 1;
173554c0a3aSHans de Goede
174554c0a3aSHans de Goede pcmdpriv->cmd_allocated_buf = rtw_zmalloc(MAX_CMDSZ + CMDBUFF_ALIGN_SZ);
175554c0a3aSHans de Goede
176*708056fbSXiaoke Wang if (!pcmdpriv->cmd_allocated_buf)
177*708056fbSXiaoke Wang return -ENOMEM;
178554c0a3aSHans de Goede
179554c0a3aSHans de Goede pcmdpriv->cmd_buf = pcmdpriv->cmd_allocated_buf + CMDBUFF_ALIGN_SZ - ((SIZE_PTR)(pcmdpriv->cmd_allocated_buf) & (CMDBUFF_ALIGN_SZ-1));
180554c0a3aSHans de Goede
181554c0a3aSHans de Goede pcmdpriv->rsp_allocated_buf = rtw_zmalloc(MAX_RSPSZ + 4);
182554c0a3aSHans de Goede
1834cdf1d0eSMadhumitha Prabakaran if (!pcmdpriv->rsp_allocated_buf) {
184*708056fbSXiaoke Wang kfree(pcmdpriv->cmd_allocated_buf);
185*708056fbSXiaoke Wang return -ENOMEM;
186554c0a3aSHans de Goede }
187554c0a3aSHans de Goede
188554c0a3aSHans de Goede pcmdpriv->rsp_buf = pcmdpriv->rsp_allocated_buf + 4 - ((SIZE_PTR)(pcmdpriv->rsp_allocated_buf) & 3);
189554c0a3aSHans de Goede
190c42a4ac4SSimran Singhal pcmdpriv->cmd_issued_cnt = 0;
191c42a4ac4SSimran Singhal pcmdpriv->cmd_done_cnt = 0;
192c42a4ac4SSimran Singhal pcmdpriv->rsp_cnt = 0;
193554c0a3aSHans de Goede
194554c0a3aSHans de Goede mutex_init(&pcmdpriv->sctx_mutex);
195*708056fbSXiaoke Wang
196*708056fbSXiaoke Wang return 0;
197554c0a3aSHans de Goede }
198554c0a3aSHans de Goede
19900d5865cSMarco Cesati static void c2h_wk_callback(struct work_struct *work);
rtw_init_evt_priv(struct evt_priv * pevtpriv)200b1c30bd6SMadhumitha Prabakaran int rtw_init_evt_priv(struct evt_priv *pevtpriv)
201554c0a3aSHans de Goede {
202554c0a3aSHans de Goede /* allocate DMA-able/Non-Page memory for cmd_buf and rsp_buf */
203554c0a3aSHans de Goede atomic_set(&pevtpriv->event_seq, 0);
204554c0a3aSHans de Goede pevtpriv->evt_done_cnt = 0;
205554c0a3aSHans de Goede
206554c0a3aSHans de Goede _init_workitem(&pevtpriv->c2h_wk, c2h_wk_callback, NULL);
207554c0a3aSHans de Goede pevtpriv->c2h_wk_alive = false;
208554c0a3aSHans de Goede pevtpriv->c2h_queue = rtw_cbuf_alloc(C2H_QUEUE_MAX_LEN+1);
20959dbadcdSMadhumitha Prabakaran if (!pevtpriv->c2h_queue)
21059dbadcdSMadhumitha Prabakaran return -ENOMEM;
211554c0a3aSHans de Goede
21291734498SMadhumitha Prabakaran return 0;
213554c0a3aSHans de Goede }
214554c0a3aSHans de Goede
_rtw_free_evt_priv(struct evt_priv * pevtpriv)215554c0a3aSHans de Goede void _rtw_free_evt_priv(struct evt_priv *pevtpriv)
216554c0a3aSHans de Goede {
217554c0a3aSHans de Goede _cancel_workitem_sync(&pevtpriv->c2h_wk);
218554c0a3aSHans de Goede while (pevtpriv->c2h_wk_alive)
219554c0a3aSHans de Goede msleep(10);
220554c0a3aSHans de Goede
221554c0a3aSHans de Goede while (!rtw_cbuf_empty(pevtpriv->c2h_queue)) {
222554c0a3aSHans de Goede void *c2h = rtw_cbuf_pop(pevtpriv->c2h_queue);
223c57f4f00SPhilippe Dixon
2248f870aabSManuel Palenzuela if (c2h && c2h != (void *)pevtpriv)
225554c0a3aSHans de Goede kfree(c2h);
226554c0a3aSHans de Goede }
227554c0a3aSHans de Goede kfree(pevtpriv->c2h_queue);
228554c0a3aSHans de Goede }
229554c0a3aSHans de Goede
_rtw_free_cmd_priv(struct cmd_priv * pcmdpriv)230554c0a3aSHans de Goede void _rtw_free_cmd_priv(struct cmd_priv *pcmdpriv)
231554c0a3aSHans de Goede {
232554c0a3aSHans de Goede if (pcmdpriv) {
233554c0a3aSHans de Goede kfree(pcmdpriv->cmd_allocated_buf);
234554c0a3aSHans de Goede
235554c0a3aSHans de Goede kfree(pcmdpriv->rsp_allocated_buf);
236554c0a3aSHans de Goede
237554c0a3aSHans de Goede mutex_destroy(&pcmdpriv->sctx_mutex);
238554c0a3aSHans de Goede }
239554c0a3aSHans de Goede }
240554c0a3aSHans de Goede
241554c0a3aSHans de Goede /*
242c57f4f00SPhilippe Dixon * Calling Context:
243c57f4f00SPhilippe Dixon *
244c57f4f00SPhilippe Dixon * rtw_enqueue_cmd can only be called between kernel thread,
245c57f4f00SPhilippe Dixon * since only spin_lock is used.
246c57f4f00SPhilippe Dixon *
247c57f4f00SPhilippe Dixon * ISR/Call-Back functions can't call this sub-function.
248c57f4f00SPhilippe Dixon *
249554c0a3aSHans de Goede */
250554c0a3aSHans de Goede
_rtw_enqueue_cmd(struct __queue * queue,struct cmd_obj * obj)251e4432160SMadhumitha Prabakaran int _rtw_enqueue_cmd(struct __queue *queue, struct cmd_obj *obj)
252554c0a3aSHans de Goede {
25300d5865cSMarco Cesati unsigned long irqL;
254554c0a3aSHans de Goede
255cd1f1450SMichael Straube if (!obj)
256554c0a3aSHans de Goede goto exit;
257554c0a3aSHans de Goede
258554c0a3aSHans de Goede /* spin_lock_bh(&queue->lock); */
259554c0a3aSHans de Goede spin_lock_irqsave(&queue->lock, irqL);
260554c0a3aSHans de Goede
261554c0a3aSHans de Goede list_add_tail(&obj->list, &queue->queue);
262554c0a3aSHans de Goede
263554c0a3aSHans de Goede /* spin_unlock_bh(&queue->lock); */
264554c0a3aSHans de Goede spin_unlock_irqrestore(&queue->lock, irqL);
265554c0a3aSHans de Goede
266554c0a3aSHans de Goede exit:
267554c0a3aSHans de Goede return _SUCCESS;
268554c0a3aSHans de Goede }
269554c0a3aSHans de Goede
_rtw_dequeue_cmd(struct __queue * queue)270554c0a3aSHans de Goede struct cmd_obj *_rtw_dequeue_cmd(struct __queue *queue)
271554c0a3aSHans de Goede {
27200d5865cSMarco Cesati unsigned long irqL;
273554c0a3aSHans de Goede struct cmd_obj *obj;
274554c0a3aSHans de Goede
275554c0a3aSHans de Goede /* spin_lock_bh(&(queue->lock)); */
276554c0a3aSHans de Goede spin_lock_irqsave(&queue->lock, irqL);
27753303e7aSKushal Kothari if (list_empty(&queue->queue))
278554c0a3aSHans de Goede obj = NULL;
279554c0a3aSHans de Goede else {
28053303e7aSKushal Kothari obj = container_of(get_next(&queue->queue), struct cmd_obj, list);
281554c0a3aSHans de Goede list_del_init(&obj->list);
282554c0a3aSHans de Goede }
283554c0a3aSHans de Goede
284554c0a3aSHans de Goede /* spin_unlock_bh(&(queue->lock)); */
285554c0a3aSHans de Goede spin_unlock_irqrestore(&queue->lock, irqL);
286554c0a3aSHans de Goede
287554c0a3aSHans de Goede return obj;
288554c0a3aSHans de Goede }
289554c0a3aSHans de Goede
rtw_free_evt_priv(struct evt_priv * pevtpriv)290554c0a3aSHans de Goede void rtw_free_evt_priv(struct evt_priv *pevtpriv)
291554c0a3aSHans de Goede {
292554c0a3aSHans de Goede _rtw_free_evt_priv(pevtpriv);
293554c0a3aSHans de Goede }
294554c0a3aSHans de Goede
rtw_free_cmd_priv(struct cmd_priv * pcmdpriv)295554c0a3aSHans de Goede void rtw_free_cmd_priv(struct cmd_priv *pcmdpriv)
296554c0a3aSHans de Goede {
297554c0a3aSHans de Goede _rtw_free_cmd_priv(pcmdpriv);
298554c0a3aSHans de Goede }
299554c0a3aSHans de Goede
300554c0a3aSHans de Goede int rtw_cmd_filter(struct cmd_priv *pcmdpriv, struct cmd_obj *cmd_obj);
rtw_cmd_filter(struct cmd_priv * pcmdpriv,struct cmd_obj * cmd_obj)301554c0a3aSHans de Goede int rtw_cmd_filter(struct cmd_priv *pcmdpriv, struct cmd_obj *cmd_obj)
302554c0a3aSHans de Goede {
303554c0a3aSHans de Goede u8 bAllow = false; /* set to true to allow enqueuing cmd when hw_init_completed is false */
304554c0a3aSHans de Goede
305554c0a3aSHans de Goede if (cmd_obj->cmdcode == GEN_CMD_CODE(_SetChannelPlan))
306554c0a3aSHans de Goede bAllow = true;
307554c0a3aSHans de Goede
308cf8f6446SKushal Kothari if ((!pcmdpriv->padapter->hw_init_completed && !bAllow) ||
309cf8f6446SKushal Kothari !atomic_read(&pcmdpriv->cmdthd_running)) /* com_thread not running */
310554c0a3aSHans de Goede return _FAIL;
311709c8e49SFabio Aiuto
312554c0a3aSHans de Goede return _SUCCESS;
313554c0a3aSHans de Goede }
314554c0a3aSHans de Goede
rtw_enqueue_cmd(struct cmd_priv * pcmdpriv,struct cmd_obj * cmd_obj)315e4432160SMadhumitha Prabakaran int rtw_enqueue_cmd(struct cmd_priv *pcmdpriv, struct cmd_obj *cmd_obj)
316554c0a3aSHans de Goede {
317554c0a3aSHans de Goede int res = _FAIL;
318554c0a3aSHans de Goede struct adapter *padapter = pcmdpriv->padapter;
319554c0a3aSHans de Goede
320cd1f1450SMichael Straube if (!cmd_obj)
321554c0a3aSHans de Goede goto exit;
322554c0a3aSHans de Goede
323554c0a3aSHans de Goede cmd_obj->padapter = padapter;
324554c0a3aSHans de Goede
325554c0a3aSHans de Goede res = rtw_cmd_filter(pcmdpriv, cmd_obj);
32692576c84SManuel Palenzuela if (res == _FAIL) {
327554c0a3aSHans de Goede rtw_free_cmd_obj(cmd_obj);
328554c0a3aSHans de Goede goto exit;
329554c0a3aSHans de Goede }
330554c0a3aSHans de Goede
331554c0a3aSHans de Goede res = _rtw_enqueue_cmd(&pcmdpriv->cmd_queue, cmd_obj);
332554c0a3aSHans de Goede
333554c0a3aSHans de Goede if (res == _SUCCESS)
33409a8ea34SArnd Bergmann complete(&pcmdpriv->cmd_queue_comp);
335554c0a3aSHans de Goede
336554c0a3aSHans de Goede exit:
337554c0a3aSHans de Goede return res;
338554c0a3aSHans de Goede }
339554c0a3aSHans de Goede
rtw_dequeue_cmd(struct cmd_priv * pcmdpriv)340554c0a3aSHans de Goede struct cmd_obj *rtw_dequeue_cmd(struct cmd_priv *pcmdpriv)
341554c0a3aSHans de Goede {
3421b590af9SSimran Singhal return _rtw_dequeue_cmd(&pcmdpriv->cmd_queue);
343554c0a3aSHans de Goede }
344554c0a3aSHans de Goede
rtw_free_cmd_obj(struct cmd_obj * pcmd)345554c0a3aSHans de Goede void rtw_free_cmd_obj(struct cmd_obj *pcmd)
346554c0a3aSHans de Goede {
347554c0a3aSHans de Goede if ((pcmd->cmdcode != _JoinBss_CMD_) &&
348554c0a3aSHans de Goede (pcmd->cmdcode != _CreateBss_CMD_)) {
349554c0a3aSHans de Goede /* free parmbuf in cmd_obj */
3502dac96b3SNachammai Karuppiah kfree(pcmd->parmbuf);
351554c0a3aSHans de Goede }
352554c0a3aSHans de Goede
35334557e23SIzabela Bakollari if (pcmd->rsp) {
354554c0a3aSHans de Goede if (pcmd->rspsz != 0) {
355554c0a3aSHans de Goede /* free rsp in cmd_obj */
3562dac96b3SNachammai Karuppiah kfree(pcmd->rsp);
357554c0a3aSHans de Goede }
358554c0a3aSHans de Goede }
359554c0a3aSHans de Goede
360554c0a3aSHans de Goede /* free cmd_obj */
361512bbd7bSSrishti Sharma kfree(pcmd);
362554c0a3aSHans de Goede }
363554c0a3aSHans de Goede
rtw_stop_cmd_thread(struct adapter * adapter)364554c0a3aSHans de Goede void rtw_stop_cmd_thread(struct adapter *adapter)
365554c0a3aSHans de Goede {
366554c0a3aSHans de Goede if (adapter->cmdThread &&
36753303e7aSKushal Kothari atomic_read(&adapter->cmdpriv.cmdthd_running) &&
368554c0a3aSHans de Goede adapter->cmdpriv.stop_req == 0) {
369554c0a3aSHans de Goede adapter->cmdpriv.stop_req = 1;
37009a8ea34SArnd Bergmann complete(&adapter->cmdpriv.cmd_queue_comp);
37109a8ea34SArnd Bergmann wait_for_completion(&adapter->cmdpriv.terminate_cmdthread_comp);
372554c0a3aSHans de Goede }
373554c0a3aSHans de Goede }
374554c0a3aSHans de Goede
rtw_cmd_thread(void * context)375554c0a3aSHans de Goede int rtw_cmd_thread(void *context)
376554c0a3aSHans de Goede {
377554c0a3aSHans de Goede u8 ret;
378554c0a3aSHans de Goede struct cmd_obj *pcmd;
379d698b0a0SYueHaibing u8 *pcmdbuf;
380554c0a3aSHans de Goede u8 (*cmd_hdl)(struct adapter *padapter, u8 *pbuf);
381554c0a3aSHans de Goede void (*pcmd_callback)(struct adapter *dev, struct cmd_obj *pcmd);
382529d87b4SHimanshu Jha struct adapter *padapter = context;
38353303e7aSKushal Kothari struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
384554c0a3aSHans de Goede struct drvextra_cmd_parm *extra_parm = NULL;
385554c0a3aSHans de Goede
386554c0a3aSHans de Goede thread_enter("RTW_CMD_THREAD");
387554c0a3aSHans de Goede
388554c0a3aSHans de Goede pcmdbuf = pcmdpriv->cmd_buf;
389554c0a3aSHans de Goede
390554c0a3aSHans de Goede pcmdpriv->stop_req = 0;
39153303e7aSKushal Kothari atomic_set(&pcmdpriv->cmdthd_running, true);
39209a8ea34SArnd Bergmann complete(&pcmdpriv->terminate_cmdthread_comp);
393554c0a3aSHans de Goede
394554c0a3aSHans de Goede while (1) {
39509a8ea34SArnd Bergmann if (wait_for_completion_interruptible(&pcmdpriv->cmd_queue_comp)) {
39679df841bSFabio Aiuto netdev_dbg(padapter->pnetdev,
39779df841bSFabio Aiuto FUNC_ADPT_FMT " wait_for_completion_interruptible(&pcmdpriv->cmd_queue_comp) return != 0, break\n",
39879df841bSFabio Aiuto FUNC_ADPT_ARG(padapter));
399554c0a3aSHans de Goede break;
400554c0a3aSHans de Goede }
401554c0a3aSHans de Goede
402cf8f6446SKushal Kothari if (padapter->bDriverStopped || padapter->bSurpriseRemoved) {
40379df841bSFabio Aiuto netdev_dbg(padapter->pnetdev,
40479df841bSFabio Aiuto "%s: DriverStopped(%d) SurpriseRemoved(%d) break at line %d\n",
40579df841bSFabio Aiuto __func__, padapter->bDriverStopped,
40679df841bSFabio Aiuto padapter->bSurpriseRemoved, __LINE__);
407554c0a3aSHans de Goede break;
408554c0a3aSHans de Goede }
409554c0a3aSHans de Goede
410554c0a3aSHans de Goede if (pcmdpriv->stop_req) {
41179df841bSFabio Aiuto netdev_dbg(padapter->pnetdev,
41279df841bSFabio Aiuto FUNC_ADPT_FMT " stop_req:%u, break\n",
41379df841bSFabio Aiuto FUNC_ADPT_ARG(padapter),
41479df841bSFabio Aiuto pcmdpriv->stop_req);
415554c0a3aSHans de Goede break;
416554c0a3aSHans de Goede }
417554c0a3aSHans de Goede
4186206fdb4SFabio Aiuto if (list_empty(&pcmdpriv->cmd_queue.queue))
419554c0a3aSHans de Goede continue;
420554c0a3aSHans de Goede
42113aefa65SFabio Aiuto if (rtw_register_cmd_alive(padapter) != _SUCCESS)
422554c0a3aSHans de Goede continue;
423554c0a3aSHans de Goede
424554c0a3aSHans de Goede _next:
425cf8f6446SKushal Kothari if (padapter->bDriverStopped || padapter->bSurpriseRemoved) {
42679df841bSFabio Aiuto netdev_dbg(padapter->pnetdev,
42779df841bSFabio Aiuto "%s: DriverStopped(%d) SurpriseRemoved(%d) break at line %d\n",
42879df841bSFabio Aiuto __func__, padapter->bDriverStopped,
42979df841bSFabio Aiuto padapter->bSurpriseRemoved, __LINE__);
430554c0a3aSHans de Goede break;
431554c0a3aSHans de Goede }
432554c0a3aSHans de Goede
433554c0a3aSHans de Goede pcmd = rtw_dequeue_cmd(pcmdpriv);
434554c0a3aSHans de Goede if (!pcmd) {
435554c0a3aSHans de Goede rtw_unregister_cmd_alive(padapter);
436554c0a3aSHans de Goede continue;
437554c0a3aSHans de Goede }
438554c0a3aSHans de Goede
43992576c84SManuel Palenzuela if (rtw_cmd_filter(pcmdpriv, pcmd) == _FAIL) {
440554c0a3aSHans de Goede pcmd->res = H2C_DROPPED;
441554c0a3aSHans de Goede goto post_process;
442554c0a3aSHans de Goede }
443554c0a3aSHans de Goede
444554c0a3aSHans de Goede pcmdpriv->cmd_issued_cnt++;
445554c0a3aSHans de Goede
446046bd5c9SRoss Schmidt pcmd->cmdsz = round_up((pcmd->cmdsz), 4);
447554c0a3aSHans de Goede
448554c0a3aSHans de Goede memcpy(pcmdbuf, pcmd->parmbuf, pcmd->cmdsz);
449554c0a3aSHans de Goede
450554c0a3aSHans de Goede if (pcmd->cmdcode < ARRAY_SIZE(wlancmds)) {
451554c0a3aSHans de Goede cmd_hdl = wlancmds[pcmd->cmdcode].h2cfuns;
452554c0a3aSHans de Goede
453554c0a3aSHans de Goede if (cmd_hdl) {
454554c0a3aSHans de Goede ret = cmd_hdl(pcmd->padapter, pcmdbuf);
455554c0a3aSHans de Goede pcmd->res = ret;
456554c0a3aSHans de Goede }
457554c0a3aSHans de Goede
458554c0a3aSHans de Goede pcmdpriv->cmd_seq++;
459554c0a3aSHans de Goede } else {
460554c0a3aSHans de Goede pcmd->res = H2C_PARAMETERS_ERROR;
461554c0a3aSHans de Goede }
462554c0a3aSHans de Goede
463554c0a3aSHans de Goede cmd_hdl = NULL;
464554c0a3aSHans de Goede
465554c0a3aSHans de Goede post_process:
466554c0a3aSHans de Goede
46753303e7aSKushal Kothari if (mutex_lock_interruptible(&pcmd->padapter->cmdpriv.sctx_mutex) == 0) {
468554c0a3aSHans de Goede if (pcmd->sctx) {
46979df841bSFabio Aiuto netdev_dbg(padapter->pnetdev,
47079df841bSFabio Aiuto FUNC_ADPT_FMT " pcmd->sctx\n",
471554c0a3aSHans de Goede FUNC_ADPT_ARG(pcmd->padapter));
472554c0a3aSHans de Goede
473554c0a3aSHans de Goede if (pcmd->res == H2C_SUCCESS)
474554c0a3aSHans de Goede rtw_sctx_done(&pcmd->sctx);
475554c0a3aSHans de Goede else
476554c0a3aSHans de Goede rtw_sctx_done_err(&pcmd->sctx, RTW_SCTX_DONE_CMD_ERROR);
477554c0a3aSHans de Goede }
47853303e7aSKushal Kothari mutex_unlock(&pcmd->padapter->cmdpriv.sctx_mutex);
479554c0a3aSHans de Goede }
480554c0a3aSHans de Goede
481554c0a3aSHans de Goede /* call callback function for post-processed */
482554c0a3aSHans de Goede if (pcmd->cmdcode < ARRAY_SIZE(rtw_cmd_callback)) {
483554c0a3aSHans de Goede pcmd_callback = rtw_cmd_callback[pcmd->cmdcode].callback;
484cd1f1450SMichael Straube if (!pcmd_callback) {
485554c0a3aSHans de Goede rtw_free_cmd_obj(pcmd);
486554c0a3aSHans de Goede } else {
487554c0a3aSHans de Goede /* todo: !!! fill rsp_buf to pcmd->rsp if (pcmd->rsp!= NULL) */
488858ea450SR Veera Kumar pcmd_callback(pcmd->padapter, pcmd);/* need consider that free cmd_obj in rtw_cmd_callback */
489554c0a3aSHans de Goede }
490554c0a3aSHans de Goede } else {
491554c0a3aSHans de Goede rtw_free_cmd_obj(pcmd);
492554c0a3aSHans de Goede }
493554c0a3aSHans de Goede flush_signals_thread();
494554c0a3aSHans de Goede goto _next;
495554c0a3aSHans de Goede }
496554c0a3aSHans de Goede
497554c0a3aSHans de Goede /* free all cmd_obj resources */
498554c0a3aSHans de Goede do {
499554c0a3aSHans de Goede pcmd = rtw_dequeue_cmd(pcmdpriv);
500cd1f1450SMichael Straube if (!pcmd) {
501554c0a3aSHans de Goede rtw_unregister_cmd_alive(padapter);
502554c0a3aSHans de Goede break;
503554c0a3aSHans de Goede }
504554c0a3aSHans de Goede
505554c0a3aSHans de Goede if (pcmd->cmdcode == GEN_CMD_CODE(_Set_Drv_Extra)) {
506554c0a3aSHans de Goede extra_parm = (struct drvextra_cmd_parm *)pcmd->parmbuf;
5078f870aabSManuel Palenzuela if (extra_parm->pbuf && extra_parm->size > 0)
508554c0a3aSHans de Goede kfree(extra_parm->pbuf);
509554c0a3aSHans de Goede }
510554c0a3aSHans de Goede
511554c0a3aSHans de Goede rtw_free_cmd_obj(pcmd);
512554c0a3aSHans de Goede } while (1);
513554c0a3aSHans de Goede
51409a8ea34SArnd Bergmann complete(&pcmdpriv->terminate_cmdthread_comp);
51553303e7aSKushal Kothari atomic_set(&pcmdpriv->cmdthd_running, false);
516554c0a3aSHans de Goede
517501c8872SEric W. Biederman return 0;
518554c0a3aSHans de Goede }
519554c0a3aSHans de Goede
520554c0a3aSHans de Goede /*
521c57f4f00SPhilippe Dixon * rtw_sitesurvey_cmd(~)
522c57f4f00SPhilippe Dixon * ### NOTE:#### (!!!!)
523c57f4f00SPhilippe Dixon * MUST TAKE CARE THAT BEFORE CALLING THIS FUNC, YOU SHOULD HAVE LOCKED pmlmepriv->lock
524554c0a3aSHans de Goede */
525c57f4f00SPhilippe Dixon
rtw_sitesurvey_cmd(struct adapter * padapter,struct ndis_802_11_ssid * ssid,int ssid_num,struct rtw_ieee80211_channel * ch,int ch_num)526554c0a3aSHans de Goede u8 rtw_sitesurvey_cmd(struct adapter *padapter, struct ndis_802_11_ssid *ssid, int ssid_num,
527554c0a3aSHans de Goede struct rtw_ieee80211_channel *ch, int ch_num)
528554c0a3aSHans de Goede {
529554c0a3aSHans de Goede u8 res = _FAIL;
530554c0a3aSHans de Goede struct cmd_obj *ph2c;
531554c0a3aSHans de Goede struct sitesurvey_parm *psurveyPara;
532554c0a3aSHans de Goede struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
533554c0a3aSHans de Goede struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
534554c0a3aSHans de Goede
5358a6d92d7SKushal Kothari if (check_fwstate(pmlmepriv, _FW_LINKED))
536554c0a3aSHans de Goede rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_SCAN, 1);
537554c0a3aSHans de Goede
5382ef2b7c2SJoe Perches ph2c = rtw_zmalloc(sizeof(struct cmd_obj));
539cd1f1450SMichael Straube if (!ph2c)
540554c0a3aSHans de Goede return _FAIL;
541554c0a3aSHans de Goede
5422ef2b7c2SJoe Perches psurveyPara = rtw_zmalloc(sizeof(struct sitesurvey_parm));
543cd1f1450SMichael Straube if (!psurveyPara) {
544512bbd7bSSrishti Sharma kfree(ph2c);
545554c0a3aSHans de Goede return _FAIL;
546554c0a3aSHans de Goede }
547554c0a3aSHans de Goede
548554c0a3aSHans de Goede rtw_free_network_queue(padapter, false);
549554c0a3aSHans de Goede
550554c0a3aSHans de Goede init_h2fwcmd_w_parm_no_rsp(ph2c, psurveyPara, GEN_CMD_CODE(_SiteSurvey));
551554c0a3aSHans de Goede
552554c0a3aSHans de Goede /* psurveyPara->bsslimit = 48; */
553554c0a3aSHans de Goede psurveyPara->scan_mode = pmlmepriv->scan_mode;
554554c0a3aSHans de Goede
555554c0a3aSHans de Goede /* prepare ssid list */
556554c0a3aSHans de Goede if (ssid) {
557554c0a3aSHans de Goede int i;
558c57f4f00SPhilippe Dixon
559554c0a3aSHans de Goede for (i = 0; i < ssid_num && i < RTW_SSID_SCAN_AMOUNT; i++) {
5606994aa43SFabio Aiuto if (ssid[i].ssid_length) {
561554c0a3aSHans de Goede memcpy(&psurveyPara->ssid[i], &ssid[i], sizeof(struct ndis_802_11_ssid));
562554c0a3aSHans de Goede psurveyPara->ssid_num++;
563554c0a3aSHans de Goede }
564554c0a3aSHans de Goede }
565554c0a3aSHans de Goede }
566554c0a3aSHans de Goede
567554c0a3aSHans de Goede /* prepare channel list */
568554c0a3aSHans de Goede if (ch) {
569554c0a3aSHans de Goede int i;
570c57f4f00SPhilippe Dixon
571554c0a3aSHans de Goede for (i = 0; i < ch_num && i < RTW_CHANNEL_SCAN_AMOUNT; i++) {
572554c0a3aSHans de Goede if (ch[i].hw_value && !(ch[i].flags & RTW_IEEE80211_CHAN_DISABLED)) {
573554c0a3aSHans de Goede memcpy(&psurveyPara->ch[i], &ch[i], sizeof(struct rtw_ieee80211_channel));
574554c0a3aSHans de Goede psurveyPara->ch_num++;
575554c0a3aSHans de Goede }
576554c0a3aSHans de Goede }
577554c0a3aSHans de Goede }
578554c0a3aSHans de Goede
579554c0a3aSHans de Goede set_fwstate(pmlmepriv, _FW_UNDER_SURVEY);
580554c0a3aSHans de Goede
581554c0a3aSHans de Goede res = rtw_enqueue_cmd(pcmdpriv, ph2c);
582554c0a3aSHans de Goede
583554c0a3aSHans de Goede if (res == _SUCCESS) {
584554c0a3aSHans de Goede pmlmepriv->scan_start_time = jiffies;
585554c0a3aSHans de Goede _set_timer(&pmlmepriv->scan_to_timer, SCANNING_TIMEOUT);
586554c0a3aSHans de Goede } else {
587554c0a3aSHans de Goede _clr_fwstate_(pmlmepriv, _FW_UNDER_SURVEY);
588554c0a3aSHans de Goede }
589554c0a3aSHans de Goede return res;
590554c0a3aSHans de Goede }
591554c0a3aSHans de Goede
rtw_getbbrfreg_cmdrsp_callback(struct adapter * padapter,struct cmd_obj * pcmd)592554c0a3aSHans de Goede void rtw_getbbrfreg_cmdrsp_callback(struct adapter *padapter, struct cmd_obj *pcmd)
593554c0a3aSHans de Goede {
594554c0a3aSHans de Goede /* rtw_free_cmd_obj(pcmd); */
595512bbd7bSSrishti Sharma kfree(pcmd->parmbuf);
596512bbd7bSSrishti Sharma kfree(pcmd);
597554c0a3aSHans de Goede }
598554c0a3aSHans de Goede
rtw_createbss_cmd(struct adapter * padapter)599554c0a3aSHans de Goede u8 rtw_createbss_cmd(struct adapter *padapter)
600554c0a3aSHans de Goede {
601554c0a3aSHans de Goede struct cmd_obj *pcmd;
602554c0a3aSHans de Goede struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
603554c0a3aSHans de Goede struct wlan_bssid_ex *pdev_network = &padapter->registrypriv.dev_network;
604554c0a3aSHans de Goede u8 res = _SUCCESS;
605554c0a3aSHans de Goede
6062ef2b7c2SJoe Perches pcmd = rtw_zmalloc(sizeof(struct cmd_obj));
607cd1f1450SMichael Straube if (!pcmd) {
608554c0a3aSHans de Goede res = _FAIL;
609554c0a3aSHans de Goede goto exit;
610554c0a3aSHans de Goede }
611554c0a3aSHans de Goede
612554c0a3aSHans de Goede INIT_LIST_HEAD(&pcmd->list);
613554c0a3aSHans de Goede pcmd->cmdcode = _CreateBss_CMD_;
614554c0a3aSHans de Goede pcmd->parmbuf = (unsigned char *)pdev_network;
615554c0a3aSHans de Goede pcmd->cmdsz = get_wlan_bssid_ex_sz((struct wlan_bssid_ex *)pdev_network);
616554c0a3aSHans de Goede pcmd->rsp = NULL;
617554c0a3aSHans de Goede pcmd->rspsz = 0;
618554c0a3aSHans de Goede
619d3fcee1bSFabio Aiuto pdev_network->length = pcmd->cmdsz;
620554c0a3aSHans de Goede
621554c0a3aSHans de Goede res = rtw_enqueue_cmd(pcmdpriv, pcmd);
622554c0a3aSHans de Goede
623554c0a3aSHans de Goede exit:
624554c0a3aSHans de Goede return res;
625554c0a3aSHans de Goede }
626554c0a3aSHans de Goede
rtw_startbss_cmd(struct adapter * padapter,int flags)627e4432160SMadhumitha Prabakaran int rtw_startbss_cmd(struct adapter *padapter, int flags)
628554c0a3aSHans de Goede {
629554c0a3aSHans de Goede struct cmd_obj *pcmd;
630554c0a3aSHans de Goede struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
631554c0a3aSHans de Goede struct submit_ctx sctx;
632e4432160SMadhumitha Prabakaran int res = _SUCCESS;
633554c0a3aSHans de Goede
634554c0a3aSHans de Goede if (flags & RTW_CMDF_DIRECTLY) {
635554c0a3aSHans de Goede /* no need to enqueue, do the cmd hdl directly and free cmd parameter */
636cab77590SSaurav Girepunje start_bss_network(padapter);
637554c0a3aSHans de Goede } else {
638554c0a3aSHans de Goede /* need enqueue, prepare cmd_obj and enqueue */
6392ef2b7c2SJoe Perches pcmd = rtw_zmalloc(sizeof(struct cmd_obj));
640cd1f1450SMichael Straube if (!pcmd) {
641554c0a3aSHans de Goede res = _FAIL;
642554c0a3aSHans de Goede goto exit;
643554c0a3aSHans de Goede }
644554c0a3aSHans de Goede
645554c0a3aSHans de Goede INIT_LIST_HEAD(&pcmd->list);
646554c0a3aSHans de Goede pcmd->cmdcode = GEN_CMD_CODE(_CreateBss);
647554c0a3aSHans de Goede pcmd->parmbuf = NULL;
648554c0a3aSHans de Goede pcmd->cmdsz = 0;
649554c0a3aSHans de Goede pcmd->rsp = NULL;
650554c0a3aSHans de Goede pcmd->rspsz = 0;
651554c0a3aSHans de Goede
652554c0a3aSHans de Goede if (flags & RTW_CMDF_WAIT_ACK) {
653554c0a3aSHans de Goede pcmd->sctx = &sctx;
654554c0a3aSHans de Goede rtw_sctx_init(&sctx, 2000);
655554c0a3aSHans de Goede }
656554c0a3aSHans de Goede
657554c0a3aSHans de Goede res = rtw_enqueue_cmd(pcmdpriv, pcmd);
658554c0a3aSHans de Goede
659554c0a3aSHans de Goede if (res == _SUCCESS && (flags & RTW_CMDF_WAIT_ACK)) {
6605f8e9affSBryan Brattlof rtw_sctx_wait(&sctx);
661554c0a3aSHans de Goede if (mutex_lock_interruptible(&pcmdpriv->sctx_mutex) == 0) {
662554c0a3aSHans de Goede if (sctx.status == RTW_SCTX_SUBMITTED)
663554c0a3aSHans de Goede pcmd->sctx = NULL;
664554c0a3aSHans de Goede mutex_unlock(&pcmdpriv->sctx_mutex);
665554c0a3aSHans de Goede }
666554c0a3aSHans de Goede }
667554c0a3aSHans de Goede }
668554c0a3aSHans de Goede
669554c0a3aSHans de Goede exit:
670554c0a3aSHans de Goede return res;
671554c0a3aSHans de Goede }
672554c0a3aSHans de Goede
rtw_joinbss_cmd(struct adapter * padapter,struct wlan_network * pnetwork)673554c0a3aSHans de Goede u8 rtw_joinbss_cmd(struct adapter *padapter, struct wlan_network *pnetwork)
674554c0a3aSHans de Goede {
675d698b0a0SYueHaibing u8 res = _SUCCESS;
676554c0a3aSHans de Goede uint t_len = 0;
677554c0a3aSHans de Goede struct wlan_bssid_ex *psecnetwork;
678554c0a3aSHans de Goede struct cmd_obj *pcmd;
679554c0a3aSHans de Goede struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
680554c0a3aSHans de Goede struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
681554c0a3aSHans de Goede struct qos_priv *pqospriv = &pmlmepriv->qospriv;
682554c0a3aSHans de Goede struct security_priv *psecuritypriv = &padapter->securitypriv;
683554c0a3aSHans de Goede struct registry_priv *pregistrypriv = &padapter->registrypriv;
684554c0a3aSHans de Goede struct ht_priv *phtpriv = &pmlmepriv->htpriv;
685d3fcee1bSFabio Aiuto enum ndis_802_11_network_infrastructure ndis_network_mode = pnetwork->network.infrastructure_mode;
686554c0a3aSHans de Goede struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
68753303e7aSKushal Kothari struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
688554c0a3aSHans de Goede u32 tmp_len;
689554c0a3aSHans de Goede u8 *ptmp = NULL;
690554c0a3aSHans de Goede
6912ef2b7c2SJoe Perches pcmd = rtw_zmalloc(sizeof(struct cmd_obj));
692cd1f1450SMichael Straube if (!pcmd) {
693554c0a3aSHans de Goede res = _FAIL;
694554c0a3aSHans de Goede goto exit;
695554c0a3aSHans de Goede }
696d3fcee1bSFabio Aiuto /* for ies is fix buf size */
697554c0a3aSHans de Goede t_len = sizeof(struct wlan_bssid_ex);
698554c0a3aSHans de Goede
699554c0a3aSHans de Goede
700554c0a3aSHans de Goede /* for hidden ap to set fw_state here */
701554c0a3aSHans de Goede if (check_fwstate(pmlmepriv, WIFI_STATION_STATE|WIFI_ADHOC_STATE) != true) {
702554c0a3aSHans de Goede switch (ndis_network_mode) {
703554c0a3aSHans de Goede case Ndis802_11IBSS:
704554c0a3aSHans de Goede set_fwstate(pmlmepriv, WIFI_ADHOC_STATE);
705554c0a3aSHans de Goede break;
706554c0a3aSHans de Goede
707554c0a3aSHans de Goede case Ndis802_11Infrastructure:
708554c0a3aSHans de Goede set_fwstate(pmlmepriv, WIFI_STATION_STATE);
709554c0a3aSHans de Goede break;
710554c0a3aSHans de Goede
711554c0a3aSHans de Goede case Ndis802_11APMode:
712554c0a3aSHans de Goede case Ndis802_11AutoUnknown:
713554c0a3aSHans de Goede case Ndis802_11InfrastructureMax:
714554c0a3aSHans de Goede break;
715554c0a3aSHans de Goede }
716554c0a3aSHans de Goede }
717554c0a3aSHans de Goede
718554c0a3aSHans de Goede psecnetwork = (struct wlan_bssid_ex *)&psecuritypriv->sec_bss;
719554c0a3aSHans de Goede
720554c0a3aSHans de Goede memset(psecnetwork, 0, t_len);
721554c0a3aSHans de Goede
722554c0a3aSHans de Goede memcpy(psecnetwork, &pnetwork->network, get_wlan_bssid_ex_sz(&pnetwork->network));
723554c0a3aSHans de Goede
724d3fcee1bSFabio Aiuto psecuritypriv->authenticator_ie[0] = (unsigned char)psecnetwork->ie_length;
725554c0a3aSHans de Goede
726d3fcee1bSFabio Aiuto if ((psecnetwork->ie_length-12) < (256-1))
727d3fcee1bSFabio Aiuto memcpy(&psecuritypriv->authenticator_ie[1], &psecnetwork->ies[12], psecnetwork->ie_length-12);
7280ba8b68bSHyeonggonYoo else
729d3fcee1bSFabio Aiuto memcpy(&psecuritypriv->authenticator_ie[1], &psecnetwork->ies[12], (256-1));
730554c0a3aSHans de Goede
731d3fcee1bSFabio Aiuto psecnetwork->ie_length = 0;
732554c0a3aSHans de Goede /* Added by Albert 2009/02/18 */
733705b7c36Skyoungho koo /* If the driver wants to use the bssid to create the connection. */
734554c0a3aSHans de Goede /* If not, we have to copy the connecting AP's MAC address to it so that */
735554c0a3aSHans de Goede /* the driver just has the bssid information for PMKIDList searching. */
736554c0a3aSHans de Goede
7378a6d92d7SKushal Kothari if (!pmlmepriv->assoc_by_bssid)
738d3fcee1bSFabio Aiuto memcpy(&pmlmepriv->assoc_bssid[0], &pnetwork->network.mac_address[0], ETH_ALEN);
739554c0a3aSHans de Goede
740d3fcee1bSFabio Aiuto psecnetwork->ie_length = rtw_restruct_sec_ie(padapter, &pnetwork->network.ies[0], &psecnetwork->ies[0], pnetwork->network.ie_length);
741554c0a3aSHans de Goede
742554c0a3aSHans de Goede
743554c0a3aSHans de Goede pqospriv->qos_option = 0;
744554c0a3aSHans de Goede
745554c0a3aSHans de Goede if (pregistrypriv->wmm_enable) {
746d3fcee1bSFabio Aiuto tmp_len = rtw_restruct_wmm_ie(padapter, &pnetwork->network.ies[0], &psecnetwork->ies[0], pnetwork->network.ie_length, psecnetwork->ie_length);
747554c0a3aSHans de Goede
748d3fcee1bSFabio Aiuto if (psecnetwork->ie_length != tmp_len) {
749d3fcee1bSFabio Aiuto psecnetwork->ie_length = tmp_len;
750554c0a3aSHans de Goede pqospriv->qos_option = 1; /* There is WMM IE in this corresp. beacon */
751554c0a3aSHans de Goede } else {
752554c0a3aSHans de Goede pqospriv->qos_option = 0;/* There is no WMM IE in this corresp. beacon */
753554c0a3aSHans de Goede }
754554c0a3aSHans de Goede }
755554c0a3aSHans de Goede
756554c0a3aSHans de Goede phtpriv->ht_option = false;
757d3fcee1bSFabio Aiuto ptmp = rtw_get_ie(&pnetwork->network.ies[12], WLAN_EID_HT_CAPABILITY, &tmp_len, pnetwork->network.ie_length-12);
758554c0a3aSHans de Goede if (pregistrypriv->ht_enable && ptmp && tmp_len > 0) {
759554c0a3aSHans de Goede /* Added by Albert 2010/06/23 */
760554c0a3aSHans de Goede /* For the WEP mode, we will use the bg mode to do the connection to avoid some IOT issue. */
761554c0a3aSHans de Goede /* Especially for Realtek 8192u SoftAP. */
762554c0a3aSHans de Goede if ((padapter->securitypriv.dot11PrivacyAlgrthm != _WEP40_) &&
763554c0a3aSHans de Goede (padapter->securitypriv.dot11PrivacyAlgrthm != _WEP104_) &&
764554c0a3aSHans de Goede (padapter->securitypriv.dot11PrivacyAlgrthm != _TKIP_)) {
765554c0a3aSHans de Goede rtw_ht_use_default_setting(padapter);
766554c0a3aSHans de Goede
767d3fcee1bSFabio Aiuto rtw_build_wmm_ie_ht(padapter, &psecnetwork->ies[12], &psecnetwork->ie_length);
768554c0a3aSHans de Goede
769554c0a3aSHans de Goede /* rtw_restructure_ht_ie */
770d3fcee1bSFabio Aiuto rtw_restructure_ht_ie(padapter, &pnetwork->network.ies[12], &psecnetwork->ies[0],
771d3fcee1bSFabio Aiuto pnetwork->network.ie_length-12, &psecnetwork->ie_length,
772d8b322b6SFabio Aiuto pnetwork->network.configuration.ds_config);
773554c0a3aSHans de Goede }
774554c0a3aSHans de Goede }
775554c0a3aSHans de Goede
776d3fcee1bSFabio Aiuto rtw_append_exented_cap(padapter, &psecnetwork->ies[0], &psecnetwork->ie_length);
777554c0a3aSHans de Goede
778d3fcee1bSFabio Aiuto pmlmeinfo->assoc_AP_vendor = check_assoc_AP(pnetwork->network.ies, pnetwork->network.ie_length);
779554c0a3aSHans de Goede
780554c0a3aSHans de Goede pcmd->cmdsz = get_wlan_bssid_ex_sz(psecnetwork);/* get cmdsz before endian conversion */
781554c0a3aSHans de Goede
782554c0a3aSHans de Goede INIT_LIST_HEAD(&pcmd->list);
783554c0a3aSHans de Goede pcmd->cmdcode = _JoinBss_CMD_;/* GEN_CMD_CODE(_JoinBss) */
784554c0a3aSHans de Goede pcmd->parmbuf = (unsigned char *)psecnetwork;
785554c0a3aSHans de Goede pcmd->rsp = NULL;
786554c0a3aSHans de Goede pcmd->rspsz = 0;
787554c0a3aSHans de Goede
788554c0a3aSHans de Goede res = rtw_enqueue_cmd(pcmdpriv, pcmd);
789554c0a3aSHans de Goede
790554c0a3aSHans de Goede exit:
791554c0a3aSHans de Goede return res;
792554c0a3aSHans de Goede }
793554c0a3aSHans de Goede
rtw_disassoc_cmd(struct adapter * padapter,u32 deauth_timeout_ms,bool enqueue)794554c0a3aSHans de Goede u8 rtw_disassoc_cmd(struct adapter *padapter, u32 deauth_timeout_ms, bool enqueue) /* for sta_mode */
795554c0a3aSHans de Goede {
796554c0a3aSHans de Goede struct cmd_obj *cmdobj = NULL;
797554c0a3aSHans de Goede struct disconnect_parm *param = NULL;
798554c0a3aSHans de Goede struct cmd_priv *cmdpriv = &padapter->cmdpriv;
799554c0a3aSHans de Goede u8 res = _SUCCESS;
800554c0a3aSHans de Goede
801554c0a3aSHans de Goede /* prepare cmd parameter */
8022ef2b7c2SJoe Perches param = rtw_zmalloc(sizeof(*param));
803cd1f1450SMichael Straube if (!param) {
804554c0a3aSHans de Goede res = _FAIL;
805554c0a3aSHans de Goede goto exit;
806554c0a3aSHans de Goede }
807554c0a3aSHans de Goede param->deauth_timeout_ms = deauth_timeout_ms;
808554c0a3aSHans de Goede
809554c0a3aSHans de Goede if (enqueue) {
810554c0a3aSHans de Goede /* need enqueue, prepare cmd_obj and enqueue */
8112ef2b7c2SJoe Perches cmdobj = rtw_zmalloc(sizeof(*cmdobj));
812cd1f1450SMichael Straube if (!cmdobj) {
813554c0a3aSHans de Goede res = _FAIL;
814512bbd7bSSrishti Sharma kfree(param);
815554c0a3aSHans de Goede goto exit;
816554c0a3aSHans de Goede }
817554c0a3aSHans de Goede init_h2fwcmd_w_parm_no_rsp(cmdobj, param, _DisConnect_CMD_);
818554c0a3aSHans de Goede res = rtw_enqueue_cmd(cmdpriv, cmdobj);
819554c0a3aSHans de Goede } else {
820554c0a3aSHans de Goede /* no need to enqueue, do the cmd hdl directly and free cmd parameter */
82192576c84SManuel Palenzuela if (disconnect_hdl(padapter, (u8 *)param) != H2C_SUCCESS)
822554c0a3aSHans de Goede res = _FAIL;
823512bbd7bSSrishti Sharma kfree(param);
824554c0a3aSHans de Goede }
825554c0a3aSHans de Goede
826554c0a3aSHans de Goede exit:
827554c0a3aSHans de Goede return res;
828554c0a3aSHans de Goede }
829554c0a3aSHans de Goede
rtw_setopmode_cmd(struct adapter * padapter,enum ndis_802_11_network_infrastructure networktype,bool enqueue)8309e4b6c19SMarco Cesati u8 rtw_setopmode_cmd(struct adapter *padapter, enum ndis_802_11_network_infrastructure networktype, bool enqueue)
831554c0a3aSHans de Goede {
832554c0a3aSHans de Goede struct cmd_obj *ph2c;
833554c0a3aSHans de Goede struct setopmode_parm *psetop;
834554c0a3aSHans de Goede
835554c0a3aSHans de Goede struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
836554c0a3aSHans de Goede u8 res = _SUCCESS;
837554c0a3aSHans de Goede
8382ef2b7c2SJoe Perches psetop = rtw_zmalloc(sizeof(struct setopmode_parm));
839554c0a3aSHans de Goede
840cd1f1450SMichael Straube if (!psetop) {
841554c0a3aSHans de Goede res = _FAIL;
842554c0a3aSHans de Goede goto exit;
843554c0a3aSHans de Goede }
844554c0a3aSHans de Goede psetop->mode = (u8)networktype;
845554c0a3aSHans de Goede
846554c0a3aSHans de Goede if (enqueue) {
8472ef2b7c2SJoe Perches ph2c = rtw_zmalloc(sizeof(struct cmd_obj));
848cd1f1450SMichael Straube if (!ph2c) {
849512bbd7bSSrishti Sharma kfree(psetop);
850554c0a3aSHans de Goede res = _FAIL;
851554c0a3aSHans de Goede goto exit;
852554c0a3aSHans de Goede }
853554c0a3aSHans de Goede
854554c0a3aSHans de Goede init_h2fwcmd_w_parm_no_rsp(ph2c, psetop, _SetOpMode_CMD_);
855554c0a3aSHans de Goede res = rtw_enqueue_cmd(pcmdpriv, ph2c);
856554c0a3aSHans de Goede } else {
857554c0a3aSHans de Goede setopmode_hdl(padapter, (u8 *)psetop);
858512bbd7bSSrishti Sharma kfree(psetop);
859554c0a3aSHans de Goede }
860554c0a3aSHans de Goede exit:
861554c0a3aSHans de Goede return res;
862554c0a3aSHans de Goede }
863554c0a3aSHans de Goede
rtw_setstakey_cmd(struct adapter * padapter,struct sta_info * sta,u8 unicast_key,bool enqueue)864554c0a3aSHans de Goede u8 rtw_setstakey_cmd(struct adapter *padapter, struct sta_info *sta, u8 unicast_key, bool enqueue)
865554c0a3aSHans de Goede {
866554c0a3aSHans de Goede struct cmd_obj *ph2c;
867554c0a3aSHans de Goede struct set_stakey_parm *psetstakey_para;
868554c0a3aSHans de Goede struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
869554c0a3aSHans de Goede struct set_stakey_rsp *psetstakey_rsp = NULL;
870554c0a3aSHans de Goede struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
871554c0a3aSHans de Goede struct security_priv *psecuritypriv = &padapter->securitypriv;
872554c0a3aSHans de Goede u8 res = _SUCCESS;
873554c0a3aSHans de Goede
8742ef2b7c2SJoe Perches psetstakey_para = rtw_zmalloc(sizeof(struct set_stakey_parm));
875cd1f1450SMichael Straube if (!psetstakey_para) {
876554c0a3aSHans de Goede res = _FAIL;
877554c0a3aSHans de Goede goto exit;
878554c0a3aSHans de Goede }
879554c0a3aSHans de Goede
880554c0a3aSHans de Goede memcpy(psetstakey_para->addr, sta->hwaddr, ETH_ALEN);
881554c0a3aSHans de Goede
8820ba8b68bSHyeonggonYoo if (check_fwstate(pmlmepriv, WIFI_STATION_STATE))
883554c0a3aSHans de Goede psetstakey_para->algorithm = (unsigned char)psecuritypriv->dot11PrivacyAlgrthm;
8840ba8b68bSHyeonggonYoo else
885554c0a3aSHans de Goede GET_ENCRY_ALGO(psecuritypriv, sta, psetstakey_para->algorithm, false);
886554c0a3aSHans de Goede
887cf8f6446SKushal Kothari if (unicast_key)
888554c0a3aSHans de Goede memcpy(&psetstakey_para->key, &sta->dot118021x_UncstKey, 16);
8890ba8b68bSHyeonggonYoo else
890554c0a3aSHans de Goede memcpy(&psetstakey_para->key, &psecuritypriv->dot118021XGrpKey[psecuritypriv->dot118021XGrpKeyid].skey, 16);
891554c0a3aSHans de Goede
892858ea450SR Veera Kumar /* jeff: set this because at least sw key is ready */
893554c0a3aSHans de Goede padapter->securitypriv.busetkipkey = true;
894554c0a3aSHans de Goede
895554c0a3aSHans de Goede if (enqueue) {
8962ef2b7c2SJoe Perches ph2c = rtw_zmalloc(sizeof(struct cmd_obj));
897cd1f1450SMichael Straube if (!ph2c) {
898512bbd7bSSrishti Sharma kfree(psetstakey_para);
899554c0a3aSHans de Goede res = _FAIL;
900554c0a3aSHans de Goede goto exit;
901554c0a3aSHans de Goede }
902554c0a3aSHans de Goede
9032ef2b7c2SJoe Perches psetstakey_rsp = rtw_zmalloc(sizeof(struct set_stakey_rsp));
904cd1f1450SMichael Straube if (!psetstakey_rsp) {
905512bbd7bSSrishti Sharma kfree(ph2c);
906512bbd7bSSrishti Sharma kfree(psetstakey_para);
907554c0a3aSHans de Goede res = _FAIL;
908554c0a3aSHans de Goede goto exit;
909554c0a3aSHans de Goede }
910554c0a3aSHans de Goede
911554c0a3aSHans de Goede init_h2fwcmd_w_parm_no_rsp(ph2c, psetstakey_para, _SetStaKey_CMD_);
912554c0a3aSHans de Goede ph2c->rsp = (u8 *)psetstakey_rsp;
913554c0a3aSHans de Goede ph2c->rspsz = sizeof(struct set_stakey_rsp);
914554c0a3aSHans de Goede res = rtw_enqueue_cmd(pcmdpriv, ph2c);
915554c0a3aSHans de Goede } else {
916554c0a3aSHans de Goede set_stakey_hdl(padapter, (u8 *)psetstakey_para);
917512bbd7bSSrishti Sharma kfree(psetstakey_para);
918554c0a3aSHans de Goede }
919554c0a3aSHans de Goede exit:
920554c0a3aSHans de Goede return res;
921554c0a3aSHans de Goede }
922554c0a3aSHans de Goede
rtw_clearstakey_cmd(struct adapter * padapter,struct sta_info * sta,u8 enqueue)923554c0a3aSHans de Goede u8 rtw_clearstakey_cmd(struct adapter *padapter, struct sta_info *sta, u8 enqueue)
924554c0a3aSHans de Goede {
925554c0a3aSHans de Goede struct cmd_obj *ph2c;
926554c0a3aSHans de Goede struct set_stakey_parm *psetstakey_para;
927554c0a3aSHans de Goede struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
928554c0a3aSHans de Goede struct set_stakey_rsp *psetstakey_rsp = NULL;
929554c0a3aSHans de Goede s16 cam_id = 0;
930554c0a3aSHans de Goede u8 res = _SUCCESS;
931554c0a3aSHans de Goede
932554c0a3aSHans de Goede if (!enqueue) {
933554c0a3aSHans de Goede while ((cam_id = rtw_camid_search(padapter, sta->hwaddr, -1)) >= 0) {
93479df841bSFabio Aiuto netdev_dbg(padapter->pnetdev,
93579df841bSFabio Aiuto "clear key for addr:%pM, camid:%d\n",
93679df841bSFabio Aiuto MAC_ARG(sta->hwaddr), cam_id);
937554c0a3aSHans de Goede clear_cam_entry(padapter, cam_id);
938554c0a3aSHans de Goede rtw_camid_free(padapter, cam_id);
939554c0a3aSHans de Goede }
940554c0a3aSHans de Goede } else {
9412ef2b7c2SJoe Perches ph2c = rtw_zmalloc(sizeof(struct cmd_obj));
942cd1f1450SMichael Straube if (!ph2c) {
943554c0a3aSHans de Goede res = _FAIL;
944554c0a3aSHans de Goede goto exit;
945554c0a3aSHans de Goede }
946554c0a3aSHans de Goede
9472ef2b7c2SJoe Perches psetstakey_para = rtw_zmalloc(sizeof(struct set_stakey_parm));
948cd1f1450SMichael Straube if (!psetstakey_para) {
949512bbd7bSSrishti Sharma kfree(ph2c);
950554c0a3aSHans de Goede res = _FAIL;
951554c0a3aSHans de Goede goto exit;
952554c0a3aSHans de Goede }
953554c0a3aSHans de Goede
9542ef2b7c2SJoe Perches psetstakey_rsp = rtw_zmalloc(sizeof(struct set_stakey_rsp));
955cd1f1450SMichael Straube if (!psetstakey_rsp) {
956512bbd7bSSrishti Sharma kfree(ph2c);
957512bbd7bSSrishti Sharma kfree(psetstakey_para);
958554c0a3aSHans de Goede res = _FAIL;
959554c0a3aSHans de Goede goto exit;
960554c0a3aSHans de Goede }
961554c0a3aSHans de Goede
962554c0a3aSHans de Goede init_h2fwcmd_w_parm_no_rsp(ph2c, psetstakey_para, _SetStaKey_CMD_);
963554c0a3aSHans de Goede ph2c->rsp = (u8 *)psetstakey_rsp;
964554c0a3aSHans de Goede ph2c->rspsz = sizeof(struct set_stakey_rsp);
965554c0a3aSHans de Goede
966554c0a3aSHans de Goede memcpy(psetstakey_para->addr, sta->hwaddr, ETH_ALEN);
967554c0a3aSHans de Goede
968554c0a3aSHans de Goede psetstakey_para->algorithm = _NO_PRIVACY_;
969554c0a3aSHans de Goede
970554c0a3aSHans de Goede res = rtw_enqueue_cmd(pcmdpriv, ph2c);
971554c0a3aSHans de Goede }
972554c0a3aSHans de Goede exit:
973554c0a3aSHans de Goede return res;
974554c0a3aSHans de Goede }
975554c0a3aSHans de Goede
rtw_addbareq_cmd(struct adapter * padapter,u8 tid,u8 * addr)976554c0a3aSHans de Goede u8 rtw_addbareq_cmd(struct adapter *padapter, u8 tid, u8 *addr)
977554c0a3aSHans de Goede {
978554c0a3aSHans de Goede struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
979554c0a3aSHans de Goede struct cmd_obj *ph2c;
980554c0a3aSHans de Goede struct addBaReq_parm *paddbareq_parm;
981554c0a3aSHans de Goede
982554c0a3aSHans de Goede u8 res = _SUCCESS;
983554c0a3aSHans de Goede
9842ef2b7c2SJoe Perches ph2c = rtw_zmalloc(sizeof(struct cmd_obj));
985cd1f1450SMichael Straube if (!ph2c) {
986554c0a3aSHans de Goede res = _FAIL;
987554c0a3aSHans de Goede goto exit;
988554c0a3aSHans de Goede }
989554c0a3aSHans de Goede
9902ef2b7c2SJoe Perches paddbareq_parm = rtw_zmalloc(sizeof(struct addBaReq_parm));
991cd1f1450SMichael Straube if (!paddbareq_parm) {
992512bbd7bSSrishti Sharma kfree(ph2c);
993554c0a3aSHans de Goede res = _FAIL;
994554c0a3aSHans de Goede goto exit;
995554c0a3aSHans de Goede }
996554c0a3aSHans de Goede
997554c0a3aSHans de Goede paddbareq_parm->tid = tid;
998554c0a3aSHans de Goede memcpy(paddbareq_parm->addr, addr, ETH_ALEN);
999554c0a3aSHans de Goede
1000554c0a3aSHans de Goede init_h2fwcmd_w_parm_no_rsp(ph2c, paddbareq_parm, GEN_CMD_CODE(_AddBAReq));
1001554c0a3aSHans de Goede
1002554c0a3aSHans de Goede /* rtw_enqueue_cmd(pcmdpriv, ph2c); */
1003554c0a3aSHans de Goede res = rtw_enqueue_cmd(pcmdpriv, ph2c);
1004554c0a3aSHans de Goede
1005554c0a3aSHans de Goede exit:
1006554c0a3aSHans de Goede return res;
1007554c0a3aSHans de Goede }
1008554c0a3aSHans de Goede /* add for CONFIG_IEEE80211W, none 11w can use it */
rtw_reset_securitypriv_cmd(struct adapter * padapter)1009554c0a3aSHans de Goede u8 rtw_reset_securitypriv_cmd(struct adapter *padapter)
1010554c0a3aSHans de Goede {
1011554c0a3aSHans de Goede struct cmd_obj *ph2c;
1012554c0a3aSHans de Goede struct drvextra_cmd_parm *pdrvextra_cmd_parm;
1013554c0a3aSHans de Goede struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
1014554c0a3aSHans de Goede u8 res = _SUCCESS;
1015554c0a3aSHans de Goede
10162ef2b7c2SJoe Perches ph2c = rtw_zmalloc(sizeof(struct cmd_obj));
1017cd1f1450SMichael Straube if (!ph2c) {
1018554c0a3aSHans de Goede res = _FAIL;
1019554c0a3aSHans de Goede goto exit;
1020554c0a3aSHans de Goede }
1021554c0a3aSHans de Goede
10222ef2b7c2SJoe Perches pdrvextra_cmd_parm = rtw_zmalloc(sizeof(struct drvextra_cmd_parm));
1023cd1f1450SMichael Straube if (!pdrvextra_cmd_parm) {
1024512bbd7bSSrishti Sharma kfree(ph2c);
1025554c0a3aSHans de Goede res = _FAIL;
1026554c0a3aSHans de Goede goto exit;
1027554c0a3aSHans de Goede }
1028554c0a3aSHans de Goede
1029554c0a3aSHans de Goede pdrvextra_cmd_parm->ec_id = RESET_SECURITYPRIV;
1030554c0a3aSHans de Goede pdrvextra_cmd_parm->type = 0;
1031554c0a3aSHans de Goede pdrvextra_cmd_parm->size = 0;
1032554c0a3aSHans de Goede pdrvextra_cmd_parm->pbuf = NULL;
1033554c0a3aSHans de Goede
1034554c0a3aSHans de Goede init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra));
1035554c0a3aSHans de Goede
1036554c0a3aSHans de Goede
1037554c0a3aSHans de Goede /* rtw_enqueue_cmd(pcmdpriv, ph2c); */
1038554c0a3aSHans de Goede res = rtw_enqueue_cmd(pcmdpriv, ph2c);
1039554c0a3aSHans de Goede exit:
1040554c0a3aSHans de Goede return res;
1041554c0a3aSHans de Goede }
1042554c0a3aSHans de Goede
rtw_free_assoc_resources_cmd(struct adapter * padapter)1043554c0a3aSHans de Goede u8 rtw_free_assoc_resources_cmd(struct adapter *padapter)
1044554c0a3aSHans de Goede {
1045554c0a3aSHans de Goede struct cmd_obj *ph2c;
1046554c0a3aSHans de Goede struct drvextra_cmd_parm *pdrvextra_cmd_parm;
1047554c0a3aSHans de Goede struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
1048554c0a3aSHans de Goede u8 res = _SUCCESS;
1049554c0a3aSHans de Goede
10502ef2b7c2SJoe Perches ph2c = rtw_zmalloc(sizeof(struct cmd_obj));
1051cd1f1450SMichael Straube if (!ph2c) {
1052554c0a3aSHans de Goede res = _FAIL;
1053554c0a3aSHans de Goede goto exit;
1054554c0a3aSHans de Goede }
1055554c0a3aSHans de Goede
10562ef2b7c2SJoe Perches pdrvextra_cmd_parm = rtw_zmalloc(sizeof(struct drvextra_cmd_parm));
1057cd1f1450SMichael Straube if (!pdrvextra_cmd_parm) {
1058512bbd7bSSrishti Sharma kfree(ph2c);
1059554c0a3aSHans de Goede res = _FAIL;
1060554c0a3aSHans de Goede goto exit;
1061554c0a3aSHans de Goede }
1062554c0a3aSHans de Goede
1063554c0a3aSHans de Goede pdrvextra_cmd_parm->ec_id = FREE_ASSOC_RESOURCES;
1064554c0a3aSHans de Goede pdrvextra_cmd_parm->type = 0;
1065554c0a3aSHans de Goede pdrvextra_cmd_parm->size = 0;
1066554c0a3aSHans de Goede pdrvextra_cmd_parm->pbuf = NULL;
1067554c0a3aSHans de Goede
1068554c0a3aSHans de Goede init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra));
1069554c0a3aSHans de Goede
1070554c0a3aSHans de Goede /* rtw_enqueue_cmd(pcmdpriv, ph2c); */
1071554c0a3aSHans de Goede res = rtw_enqueue_cmd(pcmdpriv, ph2c);
1072554c0a3aSHans de Goede exit:
1073554c0a3aSHans de Goede return res;
1074554c0a3aSHans de Goede }
1075554c0a3aSHans de Goede
rtw_dynamic_chk_wk_cmd(struct adapter * padapter)1076554c0a3aSHans de Goede u8 rtw_dynamic_chk_wk_cmd(struct adapter *padapter)
1077554c0a3aSHans de Goede {
1078554c0a3aSHans de Goede struct cmd_obj *ph2c;
1079554c0a3aSHans de Goede struct drvextra_cmd_parm *pdrvextra_cmd_parm;
1080554c0a3aSHans de Goede struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
1081554c0a3aSHans de Goede u8 res = _SUCCESS;
1082554c0a3aSHans de Goede
1083554c0a3aSHans de Goede /* only primary padapter does this cmd */
10842ef2b7c2SJoe Perches ph2c = rtw_zmalloc(sizeof(struct cmd_obj));
1085cd1f1450SMichael Straube if (!ph2c) {
1086554c0a3aSHans de Goede res = _FAIL;
1087554c0a3aSHans de Goede goto exit;
1088554c0a3aSHans de Goede }
1089554c0a3aSHans de Goede
10902ef2b7c2SJoe Perches pdrvextra_cmd_parm = rtw_zmalloc(sizeof(struct drvextra_cmd_parm));
1091cd1f1450SMichael Straube if (!pdrvextra_cmd_parm) {
1092512bbd7bSSrishti Sharma kfree(ph2c);
1093554c0a3aSHans de Goede res = _FAIL;
1094554c0a3aSHans de Goede goto exit;
1095554c0a3aSHans de Goede }
1096554c0a3aSHans de Goede
1097554c0a3aSHans de Goede pdrvextra_cmd_parm->ec_id = DYNAMIC_CHK_WK_CID;
1098554c0a3aSHans de Goede pdrvextra_cmd_parm->type = 0;
1099554c0a3aSHans de Goede pdrvextra_cmd_parm->size = 0;
1100554c0a3aSHans de Goede pdrvextra_cmd_parm->pbuf = NULL;
1101554c0a3aSHans de Goede init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra));
1102554c0a3aSHans de Goede
1103554c0a3aSHans de Goede
1104554c0a3aSHans de Goede /* rtw_enqueue_cmd(pcmdpriv, ph2c); */
1105554c0a3aSHans de Goede res = rtw_enqueue_cmd(pcmdpriv, ph2c);
1106554c0a3aSHans de Goede exit:
1107554c0a3aSHans de Goede return res;
1108554c0a3aSHans de Goede }
1109554c0a3aSHans de Goede
collect_traffic_statistics(struct adapter * padapter)1110554c0a3aSHans de Goede static void collect_traffic_statistics(struct adapter *padapter)
1111554c0a3aSHans de Goede {
1112554c0a3aSHans de Goede struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter);
1113554c0a3aSHans de Goede
1114554c0a3aSHans de Goede /* Tx */
1115554c0a3aSHans de Goede pdvobjpriv->traffic_stat.tx_bytes = padapter->xmitpriv.tx_bytes;
1116554c0a3aSHans de Goede pdvobjpriv->traffic_stat.tx_pkts = padapter->xmitpriv.tx_pkts;
1117554c0a3aSHans de Goede pdvobjpriv->traffic_stat.tx_drop = padapter->xmitpriv.tx_drop;
1118554c0a3aSHans de Goede
1119554c0a3aSHans de Goede /* Rx */
1120554c0a3aSHans de Goede pdvobjpriv->traffic_stat.rx_bytes = padapter->recvpriv.rx_bytes;
1121554c0a3aSHans de Goede pdvobjpriv->traffic_stat.rx_pkts = padapter->recvpriv.rx_pkts;
1122554c0a3aSHans de Goede pdvobjpriv->traffic_stat.rx_drop = padapter->recvpriv.rx_drop;
1123554c0a3aSHans de Goede
1124554c0a3aSHans de Goede /* Calculate throughput in last interval */
1125554c0a3aSHans de Goede pdvobjpriv->traffic_stat.cur_tx_bytes = pdvobjpriv->traffic_stat.tx_bytes - pdvobjpriv->traffic_stat.last_tx_bytes;
1126554c0a3aSHans de Goede pdvobjpriv->traffic_stat.cur_rx_bytes = pdvobjpriv->traffic_stat.rx_bytes - pdvobjpriv->traffic_stat.last_rx_bytes;
1127554c0a3aSHans de Goede pdvobjpriv->traffic_stat.last_tx_bytes = pdvobjpriv->traffic_stat.tx_bytes;
1128554c0a3aSHans de Goede pdvobjpriv->traffic_stat.last_rx_bytes = pdvobjpriv->traffic_stat.rx_bytes;
1129554c0a3aSHans de Goede
1130554c0a3aSHans de Goede pdvobjpriv->traffic_stat.cur_tx_tp = (u32)(pdvobjpriv->traffic_stat.cur_tx_bytes * 8/2/1024/1024);
1131554c0a3aSHans de Goede pdvobjpriv->traffic_stat.cur_rx_tp = (u32)(pdvobjpriv->traffic_stat.cur_rx_bytes * 8/2/1024/1024);
1132554c0a3aSHans de Goede }
1133554c0a3aSHans de Goede
traffic_status_watchdog(struct adapter * padapter,u8 from_timer)1134554c0a3aSHans de Goede u8 traffic_status_watchdog(struct adapter *padapter, u8 from_timer)
1135554c0a3aSHans de Goede {
1136554c0a3aSHans de Goede u8 bEnterPS = false;
1137554c0a3aSHans de Goede u16 BusyThresholdHigh = 25;
1138554c0a3aSHans de Goede u16 BusyThresholdLow = 10;
1139554c0a3aSHans de Goede u16 BusyThreshold = BusyThresholdHigh;
1140554c0a3aSHans de Goede u8 bBusyTraffic = false, bTxBusyTraffic = false, bRxBusyTraffic = false;
1141554c0a3aSHans de Goede u8 bHigherBusyTraffic = false, bHigherBusyRxTraffic = false, bHigherBusyTxTraffic = false;
114253303e7aSKushal Kothari struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
1143554c0a3aSHans de Goede
1144554c0a3aSHans de Goede collect_traffic_statistics(padapter);
1145554c0a3aSHans de Goede
1146554c0a3aSHans de Goede /* */
1147554c0a3aSHans de Goede /* Determine if our traffic is busy now */
1148554c0a3aSHans de Goede /* */
11498a6d92d7SKushal Kothari if ((check_fwstate(pmlmepriv, _FW_LINKED))
1150554c0a3aSHans de Goede /*&& !MgntInitAdapterInProgress(pMgntInfo)*/) {
1151554c0a3aSHans de Goede /* if we raise bBusyTraffic in last watchdog, using lower threshold. */
1152554c0a3aSHans de Goede if (pmlmepriv->LinkDetectInfo.bBusyTraffic)
1153554c0a3aSHans de Goede BusyThreshold = BusyThresholdLow;
1154554c0a3aSHans de Goede
1155554c0a3aSHans de Goede if (pmlmepriv->LinkDetectInfo.NumRxOkInPeriod > BusyThreshold ||
1156554c0a3aSHans de Goede pmlmepriv->LinkDetectInfo.NumTxOkInPeriod > BusyThreshold) {
1157554c0a3aSHans de Goede bBusyTraffic = true;
1158554c0a3aSHans de Goede
1159554c0a3aSHans de Goede if (pmlmepriv->LinkDetectInfo.NumRxOkInPeriod > pmlmepriv->LinkDetectInfo.NumTxOkInPeriod)
1160554c0a3aSHans de Goede bRxBusyTraffic = true;
1161554c0a3aSHans de Goede else
1162554c0a3aSHans de Goede bTxBusyTraffic = true;
1163554c0a3aSHans de Goede }
1164554c0a3aSHans de Goede
1165554c0a3aSHans de Goede /* Higher Tx/Rx data. */
1166554c0a3aSHans de Goede if (pmlmepriv->LinkDetectInfo.NumRxOkInPeriod > 4000 ||
1167554c0a3aSHans de Goede pmlmepriv->LinkDetectInfo.NumTxOkInPeriod > 4000) {
1168554c0a3aSHans de Goede bHigherBusyTraffic = true;
1169554c0a3aSHans de Goede
1170554c0a3aSHans de Goede if (pmlmepriv->LinkDetectInfo.NumRxOkInPeriod > pmlmepriv->LinkDetectInfo.NumTxOkInPeriod)
1171554c0a3aSHans de Goede bHigherBusyRxTraffic = true;
1172554c0a3aSHans de Goede else
1173554c0a3aSHans de Goede bHigherBusyTxTraffic = true;
1174554c0a3aSHans de Goede }
1175554c0a3aSHans de Goede
1176554c0a3aSHans de Goede /* check traffic for powersaving. */
1177554c0a3aSHans de Goede if (((pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod + pmlmepriv->LinkDetectInfo.NumTxOkInPeriod) > 8) ||
1178554c0a3aSHans de Goede (pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod > 2)) {
1179554c0a3aSHans de Goede bEnterPS = false;
1180554c0a3aSHans de Goede
1181cf8f6446SKushal Kothari if (bBusyTraffic) {
1182554c0a3aSHans de Goede if (pmlmepriv->LinkDetectInfo.TrafficTransitionCount <= 4)
1183554c0a3aSHans de Goede pmlmepriv->LinkDetectInfo.TrafficTransitionCount = 4;
1184554c0a3aSHans de Goede
1185554c0a3aSHans de Goede pmlmepriv->LinkDetectInfo.TrafficTransitionCount++;
1186554c0a3aSHans de Goede
11878f870aabSManuel Palenzuela if (pmlmepriv->LinkDetectInfo.TrafficTransitionCount > 30/*TrafficTransitionLevel*/)
1188554c0a3aSHans de Goede pmlmepriv->LinkDetectInfo.TrafficTransitionCount = 30;
1189554c0a3aSHans de Goede }
1190554c0a3aSHans de Goede } else {
1191554c0a3aSHans de Goede if (pmlmepriv->LinkDetectInfo.TrafficTransitionCount >= 2)
1192554c0a3aSHans de Goede pmlmepriv->LinkDetectInfo.TrafficTransitionCount -= 2;
1193554c0a3aSHans de Goede else
1194554c0a3aSHans de Goede pmlmepriv->LinkDetectInfo.TrafficTransitionCount = 0;
1195554c0a3aSHans de Goede
1196554c0a3aSHans de Goede if (pmlmepriv->LinkDetectInfo.TrafficTransitionCount == 0)
1197554c0a3aSHans de Goede bEnterPS = true;
1198554c0a3aSHans de Goede }
1199554c0a3aSHans de Goede
1200554c0a3aSHans de Goede /* LeisurePS only work in infra mode. */
1201554c0a3aSHans de Goede if (bEnterPS) {
1202554c0a3aSHans de Goede if (!from_timer)
1203554c0a3aSHans de Goede LPS_Enter(padapter, "TRAFFIC_IDLE");
1204554c0a3aSHans de Goede } else {
1205554c0a3aSHans de Goede if (!from_timer)
1206554c0a3aSHans de Goede LPS_Leave(padapter, "TRAFFIC_BUSY");
1207554c0a3aSHans de Goede else
1208554c0a3aSHans de Goede rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_TRAFFIC_BUSY, 1);
1209554c0a3aSHans de Goede }
1210554c0a3aSHans de Goede } else {
1211554c0a3aSHans de Goede struct dvobj_priv *dvobj = adapter_to_dvobj(padapter);
1212554c0a3aSHans de Goede int n_assoc_iface = 0;
1213554c0a3aSHans de Goede
121453303e7aSKushal Kothari if (check_fwstate(&dvobj->padapters->mlmepriv, WIFI_ASOC_STATE))
1215554c0a3aSHans de Goede n_assoc_iface++;
1216554c0a3aSHans de Goede
1217554c0a3aSHans de Goede if (!from_timer && n_assoc_iface == 0)
1218554c0a3aSHans de Goede LPS_Leave(padapter, "NON_LINKED");
1219554c0a3aSHans de Goede }
1220554c0a3aSHans de Goede
1221554c0a3aSHans de Goede pmlmepriv->LinkDetectInfo.NumRxOkInPeriod = 0;
1222554c0a3aSHans de Goede pmlmepriv->LinkDetectInfo.NumTxOkInPeriod = 0;
1223554c0a3aSHans de Goede pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod = 0;
1224554c0a3aSHans de Goede pmlmepriv->LinkDetectInfo.bBusyTraffic = bBusyTraffic;
1225554c0a3aSHans de Goede pmlmepriv->LinkDetectInfo.bTxBusyTraffic = bTxBusyTraffic;
1226554c0a3aSHans de Goede pmlmepriv->LinkDetectInfo.bRxBusyTraffic = bRxBusyTraffic;
1227554c0a3aSHans de Goede pmlmepriv->LinkDetectInfo.bHigherBusyTraffic = bHigherBusyTraffic;
1228554c0a3aSHans de Goede pmlmepriv->LinkDetectInfo.bHigherBusyRxTraffic = bHigherBusyRxTraffic;
1229554c0a3aSHans de Goede pmlmepriv->LinkDetectInfo.bHigherBusyTxTraffic = bHigherBusyTxTraffic;
1230554c0a3aSHans de Goede
1231554c0a3aSHans de Goede return bEnterPS;
1232554c0a3aSHans de Goede
1233554c0a3aSHans de Goede }
1234554c0a3aSHans de Goede
dynamic_chk_wk_hdl(struct adapter * padapter)1235554c0a3aSHans de Goede static void dynamic_chk_wk_hdl(struct adapter *padapter)
1236554c0a3aSHans de Goede {
1237554c0a3aSHans de Goede struct mlme_priv *pmlmepriv;
1238993b21a0SDonggyu Kim
123953303e7aSKushal Kothari pmlmepriv = &padapter->mlmepriv;
1240554c0a3aSHans de Goede
12418a6d92d7SKushal Kothari if (check_fwstate(pmlmepriv, WIFI_AP_STATE))
1242554c0a3aSHans de Goede expire_timeout_chk(padapter);
1243554c0a3aSHans de Goede
1244554c0a3aSHans de Goede /* for debug purpose */
1245554c0a3aSHans de Goede _linked_info_dump(padapter);
1246554c0a3aSHans de Goede /* if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING|_FW_UNDER_SURVEY) ==false) */
1247554c0a3aSHans de Goede {
1248554c0a3aSHans de Goede linked_status_chk(padapter);
1249554c0a3aSHans de Goede traffic_status_watchdog(padapter, 0);
1250554c0a3aSHans de Goede }
1251554c0a3aSHans de Goede rtw_hal_dm_watchdog(padapter);
1252554c0a3aSHans de Goede
1253554c0a3aSHans de Goede /* check_hw_pbc(padapter, pdrvextra_cmd->pbuf, pdrvextra_cmd->type); */
1254554c0a3aSHans de Goede
1255554c0a3aSHans de Goede /* */
1256554c0a3aSHans de Goede /* BT-Coexist */
1257554c0a3aSHans de Goede /* */
1258a158111dSNishka Dasgupta hal_btcoex_Handler(padapter);
1259554c0a3aSHans de Goede
1260554c0a3aSHans de Goede
1261554c0a3aSHans de Goede /* always call rtw_ps_processor() at last one. */
1262554c0a3aSHans de Goede if (is_primary_adapter(padapter))
1263554c0a3aSHans de Goede rtw_ps_processor(padapter);
1264554c0a3aSHans de Goede }
1265554c0a3aSHans de Goede
1266554c0a3aSHans de Goede void lps_ctrl_wk_hdl(struct adapter *padapter, u8 lps_ctrl_type);
lps_ctrl_wk_hdl(struct adapter * padapter,u8 lps_ctrl_type)1267554c0a3aSHans de Goede void lps_ctrl_wk_hdl(struct adapter *padapter, u8 lps_ctrl_type)
1268554c0a3aSHans de Goede {
1269554c0a3aSHans de Goede struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter);
127053303e7aSKushal Kothari struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
1271554c0a3aSHans de Goede u8 mstatus;
1272554c0a3aSHans de Goede
127353303e7aSKushal Kothari if (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) ||
127453303e7aSKushal Kothari check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)) {
1275554c0a3aSHans de Goede return;
1276554c0a3aSHans de Goede }
1277554c0a3aSHans de Goede
1278554c0a3aSHans de Goede switch (lps_ctrl_type) {
1279554c0a3aSHans de Goede case LPS_CTRL_SCAN:
1280a47a70c2SNishka Dasgupta hal_btcoex_ScanNotify(padapter, true);
1281554c0a3aSHans de Goede
12828a6d92d7SKushal Kothari if (check_fwstate(pmlmepriv, _FW_LINKED)) {
1283554c0a3aSHans de Goede /* connect */
1284554c0a3aSHans de Goede LPS_Leave(padapter, "LPS_CTRL_SCAN");
1285554c0a3aSHans de Goede }
1286554c0a3aSHans de Goede break;
1287554c0a3aSHans de Goede case LPS_CTRL_JOINBSS:
1288554c0a3aSHans de Goede LPS_Leave(padapter, "LPS_CTRL_JOINBSS");
1289554c0a3aSHans de Goede break;
1290554c0a3aSHans de Goede case LPS_CTRL_CONNECT:
1291554c0a3aSHans de Goede mstatus = 1;/* connect */
1292554c0a3aSHans de Goede /* Reset LPS Setting */
1293554c0a3aSHans de Goede pwrpriv->LpsIdleCount = 0;
1294554c0a3aSHans de Goede rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_JOINBSSRPT, (u8 *)(&mstatus));
1295554c0a3aSHans de Goede rtw_btcoex_MediaStatusNotify(padapter, mstatus);
1296554c0a3aSHans de Goede break;
1297554c0a3aSHans de Goede case LPS_CTRL_DISCONNECT:
1298554c0a3aSHans de Goede mstatus = 0;/* disconnect */
1299554c0a3aSHans de Goede rtw_btcoex_MediaStatusNotify(padapter, mstatus);
1300554c0a3aSHans de Goede LPS_Leave(padapter, "LPS_CTRL_DISCONNECT");
1301554c0a3aSHans de Goede rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_JOINBSSRPT, (u8 *)(&mstatus));
1302554c0a3aSHans de Goede break;
1303554c0a3aSHans de Goede case LPS_CTRL_SPECIAL_PACKET:
1304554c0a3aSHans de Goede pwrpriv->DelayLPSLastTimeStamp = jiffies;
1305800132aaSNishka Dasgupta hal_btcoex_SpecialPacketNotify(padapter, PACKET_DHCP);
1306554c0a3aSHans de Goede LPS_Leave(padapter, "LPS_CTRL_SPECIAL_PACKET");
1307554c0a3aSHans de Goede break;
1308554c0a3aSHans de Goede case LPS_CTRL_LEAVE:
1309554c0a3aSHans de Goede LPS_Leave(padapter, "LPS_CTRL_LEAVE");
1310554c0a3aSHans de Goede break;
1311554c0a3aSHans de Goede case LPS_CTRL_TRAFFIC_BUSY:
1312554c0a3aSHans de Goede LPS_Leave(padapter, "LPS_CTRL_TRAFFIC_BUSY");
13132811861bSGustavo A. R. Silva break;
1314554c0a3aSHans de Goede default:
1315554c0a3aSHans de Goede break;
1316554c0a3aSHans de Goede }
1317554c0a3aSHans de Goede }
1318554c0a3aSHans de Goede
rtw_lps_ctrl_wk_cmd(struct adapter * padapter,u8 lps_ctrl_type,u8 enqueue)1319554c0a3aSHans de Goede u8 rtw_lps_ctrl_wk_cmd(struct adapter *padapter, u8 lps_ctrl_type, u8 enqueue)
1320554c0a3aSHans de Goede {
1321554c0a3aSHans de Goede struct cmd_obj *ph2c;
1322554c0a3aSHans de Goede struct drvextra_cmd_parm *pdrvextra_cmd_parm;
1323554c0a3aSHans de Goede struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
1324554c0a3aSHans de Goede /* struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); */
1325554c0a3aSHans de Goede u8 res = _SUCCESS;
1326554c0a3aSHans de Goede
1327554c0a3aSHans de Goede /* if (!pwrctrlpriv->bLeisurePs) */
1328554c0a3aSHans de Goede /* return res; */
1329554c0a3aSHans de Goede
1330554c0a3aSHans de Goede if (enqueue) {
13312ef2b7c2SJoe Perches ph2c = rtw_zmalloc(sizeof(struct cmd_obj));
1332cd1f1450SMichael Straube if (!ph2c) {
1333554c0a3aSHans de Goede res = _FAIL;
1334554c0a3aSHans de Goede goto exit;
1335554c0a3aSHans de Goede }
1336554c0a3aSHans de Goede
13372ef2b7c2SJoe Perches pdrvextra_cmd_parm = rtw_zmalloc(sizeof(struct drvextra_cmd_parm));
1338cd1f1450SMichael Straube if (!pdrvextra_cmd_parm) {
1339512bbd7bSSrishti Sharma kfree(ph2c);
1340554c0a3aSHans de Goede res = _FAIL;
1341554c0a3aSHans de Goede goto exit;
1342554c0a3aSHans de Goede }
1343554c0a3aSHans de Goede
1344554c0a3aSHans de Goede pdrvextra_cmd_parm->ec_id = LPS_CTRL_WK_CID;
1345554c0a3aSHans de Goede pdrvextra_cmd_parm->type = lps_ctrl_type;
1346554c0a3aSHans de Goede pdrvextra_cmd_parm->size = 0;
1347554c0a3aSHans de Goede pdrvextra_cmd_parm->pbuf = NULL;
1348554c0a3aSHans de Goede
1349554c0a3aSHans de Goede init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra));
1350554c0a3aSHans de Goede
1351554c0a3aSHans de Goede res = rtw_enqueue_cmd(pcmdpriv, ph2c);
1352554c0a3aSHans de Goede } else {
1353554c0a3aSHans de Goede lps_ctrl_wk_hdl(padapter, lps_ctrl_type);
1354554c0a3aSHans de Goede }
1355554c0a3aSHans de Goede
1356554c0a3aSHans de Goede exit:
1357554c0a3aSHans de Goede return res;
1358554c0a3aSHans de Goede }
1359554c0a3aSHans de Goede
rtw_dm_in_lps_hdl(struct adapter * padapter)1360554c0a3aSHans de Goede static void rtw_dm_in_lps_hdl(struct adapter *padapter)
1361554c0a3aSHans de Goede {
1362554c0a3aSHans de Goede rtw_hal_set_hwreg(padapter, HW_VAR_DM_IN_LPS, NULL);
1363554c0a3aSHans de Goede }
1364554c0a3aSHans de Goede
rtw_dm_in_lps_wk_cmd(struct adapter * padapter)1365554c0a3aSHans de Goede u8 rtw_dm_in_lps_wk_cmd(struct adapter *padapter)
1366554c0a3aSHans de Goede {
1367554c0a3aSHans de Goede struct cmd_obj *ph2c;
1368554c0a3aSHans de Goede struct drvextra_cmd_parm *pdrvextra_cmd_parm;
1369554c0a3aSHans de Goede struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
1370554c0a3aSHans de Goede u8 res = _SUCCESS;
1371554c0a3aSHans de Goede
1372554c0a3aSHans de Goede
13732ef2b7c2SJoe Perches ph2c = rtw_zmalloc(sizeof(struct cmd_obj));
1374cd1f1450SMichael Straube if (!ph2c) {
1375554c0a3aSHans de Goede res = _FAIL;
1376554c0a3aSHans de Goede goto exit;
1377554c0a3aSHans de Goede }
1378554c0a3aSHans de Goede
13792ef2b7c2SJoe Perches pdrvextra_cmd_parm = rtw_zmalloc(sizeof(struct drvextra_cmd_parm));
1380cd1f1450SMichael Straube if (!pdrvextra_cmd_parm) {
1381512bbd7bSSrishti Sharma kfree(ph2c);
1382554c0a3aSHans de Goede res = _FAIL;
1383554c0a3aSHans de Goede goto exit;
1384554c0a3aSHans de Goede }
1385554c0a3aSHans de Goede
1386554c0a3aSHans de Goede pdrvextra_cmd_parm->ec_id = DM_IN_LPS_WK_CID;
1387554c0a3aSHans de Goede pdrvextra_cmd_parm->type = 0;
1388554c0a3aSHans de Goede pdrvextra_cmd_parm->size = 0;
1389554c0a3aSHans de Goede pdrvextra_cmd_parm->pbuf = NULL;
1390554c0a3aSHans de Goede
1391554c0a3aSHans de Goede init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra));
1392554c0a3aSHans de Goede
1393554c0a3aSHans de Goede res = rtw_enqueue_cmd(pcmdpriv, ph2c);
1394554c0a3aSHans de Goede
1395554c0a3aSHans de Goede exit:
1396554c0a3aSHans de Goede return res;
1397554c0a3aSHans de Goede }
1398554c0a3aSHans de Goede
rtw_lps_change_dtim_hdl(struct adapter * padapter,u8 dtim)1399554c0a3aSHans de Goede static void rtw_lps_change_dtim_hdl(struct adapter *padapter, u8 dtim)
1400554c0a3aSHans de Goede {
1401554c0a3aSHans de Goede struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter);
1402554c0a3aSHans de Goede
1403554c0a3aSHans de Goede if (dtim <= 0 || dtim > 16)
1404554c0a3aSHans de Goede return;
1405554c0a3aSHans de Goede
14068a6d92d7SKushal Kothari if (hal_btcoex_IsBtControlLps(padapter))
1407554c0a3aSHans de Goede return;
1408554c0a3aSHans de Goede
140907e3a844SArnd Bergmann mutex_lock(&pwrpriv->lock);
1410554c0a3aSHans de Goede
1411554c0a3aSHans de Goede pwrpriv->dtim = dtim;
1412554c0a3aSHans de Goede
141316ae2044SFabio M. De Francesco if (pwrpriv->fw_current_in_ps_mode && (pwrpriv->pwr_mode > PS_MODE_ACTIVE)) {
1414554c0a3aSHans de Goede u8 ps_mode = pwrpriv->pwr_mode;
1415554c0a3aSHans de Goede
1416554c0a3aSHans de Goede rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_PWRMODE, (u8 *)(&ps_mode));
1417554c0a3aSHans de Goede }
1418554c0a3aSHans de Goede
141907e3a844SArnd Bergmann mutex_unlock(&pwrpriv->lock);
1420554c0a3aSHans de Goede }
1421554c0a3aSHans de Goede
rtw_dm_ra_mask_hdl(struct adapter * padapter,struct sta_info * psta)1422554c0a3aSHans de Goede static void rtw_dm_ra_mask_hdl(struct adapter *padapter, struct sta_info *psta)
1423554c0a3aSHans de Goede {
14248f870aabSManuel Palenzuela if (psta)
1425554c0a3aSHans de Goede set_sta_rate(padapter, psta);
1426554c0a3aSHans de Goede }
1427554c0a3aSHans de Goede
rtw_dm_ra_mask_wk_cmd(struct adapter * padapter,u8 * psta)1428554c0a3aSHans de Goede u8 rtw_dm_ra_mask_wk_cmd(struct adapter *padapter, u8 *psta)
1429554c0a3aSHans de Goede {
1430554c0a3aSHans de Goede struct cmd_obj *ph2c;
1431554c0a3aSHans de Goede struct drvextra_cmd_parm *pdrvextra_cmd_parm;
1432554c0a3aSHans de Goede struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
1433554c0a3aSHans de Goede u8 res = _SUCCESS;
1434554c0a3aSHans de Goede
14352ef2b7c2SJoe Perches ph2c = rtw_zmalloc(sizeof(struct cmd_obj));
1436cd1f1450SMichael Straube if (!ph2c) {
1437554c0a3aSHans de Goede res = _FAIL;
1438554c0a3aSHans de Goede goto exit;
1439554c0a3aSHans de Goede }
1440554c0a3aSHans de Goede
14412ef2b7c2SJoe Perches pdrvextra_cmd_parm = rtw_zmalloc(sizeof(struct drvextra_cmd_parm));
1442cd1f1450SMichael Straube if (!pdrvextra_cmd_parm) {
1443512bbd7bSSrishti Sharma kfree(ph2c);
1444554c0a3aSHans de Goede res = _FAIL;
1445554c0a3aSHans de Goede goto exit;
1446554c0a3aSHans de Goede }
1447554c0a3aSHans de Goede
1448554c0a3aSHans de Goede pdrvextra_cmd_parm->ec_id = DM_RA_MSK_WK_CID;
1449554c0a3aSHans de Goede pdrvextra_cmd_parm->type = 0;
1450554c0a3aSHans de Goede pdrvextra_cmd_parm->size = 0;
1451554c0a3aSHans de Goede pdrvextra_cmd_parm->pbuf = psta;
1452554c0a3aSHans de Goede
1453554c0a3aSHans de Goede init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra));
1454554c0a3aSHans de Goede
1455554c0a3aSHans de Goede res = rtw_enqueue_cmd(pcmdpriv, ph2c);
1456554c0a3aSHans de Goede
1457554c0a3aSHans de Goede exit:
1458554c0a3aSHans de Goede
1459554c0a3aSHans de Goede return res;
1460554c0a3aSHans de Goede
1461554c0a3aSHans de Goede }
1462554c0a3aSHans de Goede
rtw_ps_cmd(struct adapter * padapter)1463554c0a3aSHans de Goede u8 rtw_ps_cmd(struct adapter *padapter)
1464554c0a3aSHans de Goede {
1465554c0a3aSHans de Goede struct cmd_obj *ppscmd;
1466554c0a3aSHans de Goede struct drvextra_cmd_parm *pdrvextra_cmd_parm;
1467554c0a3aSHans de Goede struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
1468554c0a3aSHans de Goede u8 res = _SUCCESS;
14692ef2b7c2SJoe Perches ppscmd = rtw_zmalloc(sizeof(struct cmd_obj));
1470cd1f1450SMichael Straube if (!ppscmd) {
1471554c0a3aSHans de Goede res = _FAIL;
1472554c0a3aSHans de Goede goto exit;
1473554c0a3aSHans de Goede }
1474554c0a3aSHans de Goede
14752ef2b7c2SJoe Perches pdrvextra_cmd_parm = rtw_zmalloc(sizeof(struct drvextra_cmd_parm));
1476cd1f1450SMichael Straube if (!pdrvextra_cmd_parm) {
1477512bbd7bSSrishti Sharma kfree(ppscmd);
1478554c0a3aSHans de Goede res = _FAIL;
1479554c0a3aSHans de Goede goto exit;
1480554c0a3aSHans de Goede }
1481554c0a3aSHans de Goede
1482554c0a3aSHans de Goede pdrvextra_cmd_parm->ec_id = POWER_SAVING_CTRL_WK_CID;
1483554c0a3aSHans de Goede pdrvextra_cmd_parm->type = 0;
1484554c0a3aSHans de Goede pdrvextra_cmd_parm->size = 0;
1485554c0a3aSHans de Goede pdrvextra_cmd_parm->pbuf = NULL;
1486554c0a3aSHans de Goede init_h2fwcmd_w_parm_no_rsp(ppscmd, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra));
1487554c0a3aSHans de Goede
1488554c0a3aSHans de Goede res = rtw_enqueue_cmd(pcmdpriv, ppscmd);
1489554c0a3aSHans de Goede
1490554c0a3aSHans de Goede exit:
1491554c0a3aSHans de Goede return res;
1492554c0a3aSHans de Goede }
1493554c0a3aSHans de Goede
149464b8e685SJi-Hun Kim u32 g_wait_hiq_empty;
1495f55a6d45SArnd Bergmann
rtw_chk_hi_queue_hdl(struct adapter * padapter)1496554c0a3aSHans de Goede static void rtw_chk_hi_queue_hdl(struct adapter *padapter)
1497554c0a3aSHans de Goede {
1498554c0a3aSHans de Goede struct sta_info *psta_bmc;
1499554c0a3aSHans de Goede struct sta_priv *pstapriv = &padapter->stapriv;
1500554c0a3aSHans de Goede unsigned long start = jiffies;
1501554c0a3aSHans de Goede u8 empty = false;
1502554c0a3aSHans de Goede
1503554c0a3aSHans de Goede psta_bmc = rtw_get_bcmc_stainfo(padapter);
1504554c0a3aSHans de Goede if (!psta_bmc)
1505554c0a3aSHans de Goede return;
1506554c0a3aSHans de Goede
1507554c0a3aSHans de Goede rtw_hal_get_hwreg(padapter, HW_VAR_CHK_HI_QUEUE_EMPTY, &empty);
1508554c0a3aSHans de Goede
1509cf8f6446SKushal Kothari while (!empty && jiffies_to_msecs(jiffies - start) < g_wait_hiq_empty) {
1510554c0a3aSHans de Goede msleep(100);
1511554c0a3aSHans de Goede rtw_hal_get_hwreg(padapter, HW_VAR_CHK_HI_QUEUE_EMPTY, &empty);
1512554c0a3aSHans de Goede }
1513554c0a3aSHans de Goede
1514554c0a3aSHans de Goede if (psta_bmc->sleepq_len == 0) {
1515554c0a3aSHans de Goede if (empty == _SUCCESS) {
1516554c0a3aSHans de Goede bool update_tim = false;
1517554c0a3aSHans de Goede
1518554c0a3aSHans de Goede if (pstapriv->tim_bitmap & BIT(0))
1519554c0a3aSHans de Goede update_tim = true;
1520554c0a3aSHans de Goede
1521554c0a3aSHans de Goede pstapriv->tim_bitmap &= ~BIT(0);
1522554c0a3aSHans de Goede pstapriv->sta_dz_bitmap &= ~BIT(0);
1523554c0a3aSHans de Goede
152463a9c3edSJeeeun Evans if (update_tim)
1525aaa0bc19SRoss Schmidt update_beacon(padapter, WLAN_EID_TIM, NULL, true);
1526554c0a3aSHans de Goede } else {/* re check again */
1527554c0a3aSHans de Goede rtw_chk_hi_queue_cmd(padapter);
1528554c0a3aSHans de Goede }
1529554c0a3aSHans de Goede
1530554c0a3aSHans de Goede }
1531554c0a3aSHans de Goede
1532554c0a3aSHans de Goede }
1533554c0a3aSHans de Goede
rtw_chk_hi_queue_cmd(struct adapter * padapter)1534554c0a3aSHans de Goede u8 rtw_chk_hi_queue_cmd(struct adapter *padapter)
1535554c0a3aSHans de Goede {
1536554c0a3aSHans de Goede struct cmd_obj *ph2c;
1537554c0a3aSHans de Goede struct drvextra_cmd_parm *pdrvextra_cmd_parm;
1538554c0a3aSHans de Goede struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
1539554c0a3aSHans de Goede u8 res = _SUCCESS;
1540554c0a3aSHans de Goede
15412ef2b7c2SJoe Perches ph2c = rtw_zmalloc(sizeof(struct cmd_obj));
1542cd1f1450SMichael Straube if (!ph2c) {
1543554c0a3aSHans de Goede res = _FAIL;
1544554c0a3aSHans de Goede goto exit;
1545554c0a3aSHans de Goede }
1546554c0a3aSHans de Goede
15472ef2b7c2SJoe Perches pdrvextra_cmd_parm = rtw_zmalloc(sizeof(struct drvextra_cmd_parm));
1548cd1f1450SMichael Straube if (!pdrvextra_cmd_parm) {
1549512bbd7bSSrishti Sharma kfree(ph2c);
1550554c0a3aSHans de Goede res = _FAIL;
1551554c0a3aSHans de Goede goto exit;
1552554c0a3aSHans de Goede }
1553554c0a3aSHans de Goede
1554554c0a3aSHans de Goede pdrvextra_cmd_parm->ec_id = CHECK_HIQ_WK_CID;
1555554c0a3aSHans de Goede pdrvextra_cmd_parm->type = 0;
1556554c0a3aSHans de Goede pdrvextra_cmd_parm->size = 0;
1557554c0a3aSHans de Goede pdrvextra_cmd_parm->pbuf = NULL;
1558554c0a3aSHans de Goede
1559554c0a3aSHans de Goede init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra));
1560554c0a3aSHans de Goede
1561554c0a3aSHans de Goede res = rtw_enqueue_cmd(pcmdpriv, ph2c);
1562554c0a3aSHans de Goede
1563554c0a3aSHans de Goede exit:
1564554c0a3aSHans de Goede return res;
1565554c0a3aSHans de Goede }
1566554c0a3aSHans de Goede
1567554c0a3aSHans de Goede struct btinfo {
1568554c0a3aSHans de Goede u8 cid;
1569554c0a3aSHans de Goede u8 len;
1570554c0a3aSHans de Goede
1571554c0a3aSHans de Goede u8 bConnection:1;
1572554c0a3aSHans de Goede u8 bSCOeSCO:1;
1573554c0a3aSHans de Goede u8 bInQPage:1;
1574554c0a3aSHans de Goede u8 bACLBusy:1;
1575554c0a3aSHans de Goede u8 bSCOBusy:1;
1576554c0a3aSHans de Goede u8 bHID:1;
1577554c0a3aSHans de Goede u8 bA2DP:1;
1578554c0a3aSHans de Goede u8 bFTP:1;
1579554c0a3aSHans de Goede
1580554c0a3aSHans de Goede u8 retry_cnt:4;
1581554c0a3aSHans de Goede u8 rsvd_34:1;
1582554c0a3aSHans de Goede u8 rsvd_35:1;
1583554c0a3aSHans de Goede u8 rsvd_36:1;
1584554c0a3aSHans de Goede u8 rsvd_37:1;
1585554c0a3aSHans de Goede
1586554c0a3aSHans de Goede u8 rssi;
1587554c0a3aSHans de Goede
1588554c0a3aSHans de Goede u8 rsvd_50:1;
1589554c0a3aSHans de Goede u8 rsvd_51:1;
1590554c0a3aSHans de Goede u8 rsvd_52:1;
1591554c0a3aSHans de Goede u8 rsvd_53:1;
1592554c0a3aSHans de Goede u8 rsvd_54:1;
1593554c0a3aSHans de Goede u8 rsvd_55:1;
1594554c0a3aSHans de Goede u8 eSCO_SCO:1;
1595554c0a3aSHans de Goede u8 Master_Slave:1;
1596554c0a3aSHans de Goede
1597554c0a3aSHans de Goede u8 rsvd_6;
1598554c0a3aSHans de Goede u8 rsvd_7;
1599554c0a3aSHans de Goede };
1600554c0a3aSHans de Goede
rtw_btinfo_hdl(struct adapter * adapter,u8 * buf,u16 buf_len)1601554c0a3aSHans de Goede static void rtw_btinfo_hdl(struct adapter *adapter, u8 *buf, u16 buf_len)
1602554c0a3aSHans de Goede {
1603554c0a3aSHans de Goede #define BTINFO_WIFI_FETCH 0x23
1604554c0a3aSHans de Goede #define BTINFO_BT_AUTO_RPT 0x27
1605554c0a3aSHans de Goede struct btinfo *info = (struct btinfo *)buf;
1606554c0a3aSHans de Goede u8 cmd_idx;
1607554c0a3aSHans de Goede u8 len;
1608554c0a3aSHans de Goede
1609554c0a3aSHans de Goede cmd_idx = info->cid;
1610554c0a3aSHans de Goede
1611554c0a3aSHans de Goede if (info->len > buf_len-2) {
1612554c0a3aSHans de Goede rtw_warn_on(1);
1613554c0a3aSHans de Goede len = buf_len-2;
1614554c0a3aSHans de Goede } else {
1615554c0a3aSHans de Goede len = info->len;
1616554c0a3aSHans de Goede }
1617554c0a3aSHans de Goede
1618554c0a3aSHans de Goede /* transform BT-FW btinfo to WiFI-FW C2H format and notify */
1619554c0a3aSHans de Goede if (cmd_idx == BTINFO_WIFI_FETCH)
1620554c0a3aSHans de Goede buf[1] = 0;
1621554c0a3aSHans de Goede else if (cmd_idx == BTINFO_BT_AUTO_RPT)
1622554c0a3aSHans de Goede buf[1] = 2;
1623aa0963a1SNishka Dasgupta hal_btcoex_BtInfoNotify(adapter, len+1, &buf[1]);
1624554c0a3aSHans de Goede }
1625554c0a3aSHans de Goede
rtw_c2h_packet_wk_cmd(struct adapter * padapter,u8 * pbuf,u16 length)1626554c0a3aSHans de Goede u8 rtw_c2h_packet_wk_cmd(struct adapter *padapter, u8 *pbuf, u16 length)
1627554c0a3aSHans de Goede {
1628554c0a3aSHans de Goede struct cmd_obj *ph2c;
1629554c0a3aSHans de Goede struct drvextra_cmd_parm *pdrvextra_cmd_parm;
1630554c0a3aSHans de Goede struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
1631554c0a3aSHans de Goede u8 res = _SUCCESS;
1632554c0a3aSHans de Goede
16332ef2b7c2SJoe Perches ph2c = rtw_zmalloc(sizeof(struct cmd_obj));
1634cd1f1450SMichael Straube if (!ph2c) {
1635554c0a3aSHans de Goede res = _FAIL;
1636554c0a3aSHans de Goede goto exit;
1637554c0a3aSHans de Goede }
1638554c0a3aSHans de Goede
16392ef2b7c2SJoe Perches pdrvextra_cmd_parm = rtw_zmalloc(sizeof(struct drvextra_cmd_parm));
1640cd1f1450SMichael Straube if (!pdrvextra_cmd_parm) {
1641512bbd7bSSrishti Sharma kfree(ph2c);
1642554c0a3aSHans de Goede res = _FAIL;
1643554c0a3aSHans de Goede goto exit;
1644554c0a3aSHans de Goede }
1645554c0a3aSHans de Goede
1646554c0a3aSHans de Goede pdrvextra_cmd_parm->ec_id = C2H_WK_CID;
1647554c0a3aSHans de Goede pdrvextra_cmd_parm->type = 0;
1648554c0a3aSHans de Goede pdrvextra_cmd_parm->size = length;
1649554c0a3aSHans de Goede pdrvextra_cmd_parm->pbuf = pbuf;
1650554c0a3aSHans de Goede
1651554c0a3aSHans de Goede init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra));
1652554c0a3aSHans de Goede
1653554c0a3aSHans de Goede res = rtw_enqueue_cmd(pcmdpriv, ph2c);
1654554c0a3aSHans de Goede
1655554c0a3aSHans de Goede exit:
1656554c0a3aSHans de Goede return res;
1657554c0a3aSHans de Goede }
1658554c0a3aSHans de Goede
1659554c0a3aSHans de Goede /* dont call R/W in this function, beucase SDIO interrupt have claim host */
1660554c0a3aSHans de Goede /* or deadlock will happen and cause special-systemserver-died in android */
rtw_c2h_wk_cmd(struct adapter * padapter,u8 * c2h_evt)1661554c0a3aSHans de Goede u8 rtw_c2h_wk_cmd(struct adapter *padapter, u8 *c2h_evt)
1662554c0a3aSHans de Goede {
1663554c0a3aSHans de Goede struct cmd_obj *ph2c;
1664554c0a3aSHans de Goede struct drvextra_cmd_parm *pdrvextra_cmd_parm;
1665554c0a3aSHans de Goede struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
1666554c0a3aSHans de Goede u8 res = _SUCCESS;
1667554c0a3aSHans de Goede
16682ef2b7c2SJoe Perches ph2c = rtw_zmalloc(sizeof(struct cmd_obj));
1669cd1f1450SMichael Straube if (!ph2c) {
1670554c0a3aSHans de Goede res = _FAIL;
1671554c0a3aSHans de Goede goto exit;
1672554c0a3aSHans de Goede }
1673554c0a3aSHans de Goede
16742ef2b7c2SJoe Perches pdrvextra_cmd_parm = rtw_zmalloc(sizeof(struct drvextra_cmd_parm));
1675cd1f1450SMichael Straube if (!pdrvextra_cmd_parm) {
1676512bbd7bSSrishti Sharma kfree(ph2c);
1677554c0a3aSHans de Goede res = _FAIL;
1678554c0a3aSHans de Goede goto exit;
1679554c0a3aSHans de Goede }
1680554c0a3aSHans de Goede
1681554c0a3aSHans de Goede pdrvextra_cmd_parm->ec_id = C2H_WK_CID;
1682554c0a3aSHans de Goede pdrvextra_cmd_parm->type = 0;
1683554c0a3aSHans de Goede pdrvextra_cmd_parm->size = c2h_evt?16:0;
1684554c0a3aSHans de Goede pdrvextra_cmd_parm->pbuf = c2h_evt;
1685554c0a3aSHans de Goede
1686554c0a3aSHans de Goede init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra));
1687554c0a3aSHans de Goede
1688554c0a3aSHans de Goede res = rtw_enqueue_cmd(pcmdpriv, ph2c);
1689554c0a3aSHans de Goede
1690554c0a3aSHans de Goede exit:
1691554c0a3aSHans de Goede
1692554c0a3aSHans de Goede return res;
1693554c0a3aSHans de Goede }
1694554c0a3aSHans de Goede
c2h_wk_callback(struct work_struct * work)169500d5865cSMarco Cesati static void c2h_wk_callback(struct work_struct *work)
1696554c0a3aSHans de Goede {
1697554c0a3aSHans de Goede struct evt_priv *evtpriv = container_of(work, struct evt_priv, c2h_wk);
1698554c0a3aSHans de Goede struct adapter *adapter = container_of(evtpriv, struct adapter, evtpriv);
1699554c0a3aSHans de Goede u8 *c2h_evt;
1700554c0a3aSHans de Goede c2h_id_filter ccx_id_filter = rtw_hal_c2h_id_filter_ccx(adapter);
1701554c0a3aSHans de Goede
1702554c0a3aSHans de Goede evtpriv->c2h_wk_alive = true;
1703554c0a3aSHans de Goede
1704554c0a3aSHans de Goede while (!rtw_cbuf_empty(evtpriv->c2h_queue)) {
1705554c0a3aSHans de Goede c2h_evt = (u8 *)rtw_cbuf_pop(evtpriv->c2h_queue);
170634557e23SIzabela Bakollari if (c2h_evt) {
1707554c0a3aSHans de Goede /* This C2H event is read, clear it */
1708554c0a3aSHans de Goede c2h_evt_clear(adapter);
1709554c0a3aSHans de Goede } else {
17102ef2b7c2SJoe Perches c2h_evt = rtw_malloc(16);
171134557e23SIzabela Bakollari if (c2h_evt) {
1712554c0a3aSHans de Goede /* This C2H event is not read, read & clear now */
1713414faeb1SNishka Dasgupta if (c2h_evt_read_88xx(adapter, c2h_evt) != _SUCCESS) {
1714554c0a3aSHans de Goede kfree(c2h_evt);
1715554c0a3aSHans de Goede continue;
1716554c0a3aSHans de Goede }
1717554c0a3aSHans de Goede }
1718554c0a3aSHans de Goede }
1719554c0a3aSHans de Goede
1720554c0a3aSHans de Goede /* Special pointer to trigger c2h_evt_clear only */
1721554c0a3aSHans de Goede if ((void *)c2h_evt == (void *)evtpriv)
1722554c0a3aSHans de Goede continue;
1723554c0a3aSHans de Goede
1724554c0a3aSHans de Goede if (!rtw_hal_c2h_valid(adapter, c2h_evt)) {
1725554c0a3aSHans de Goede kfree(c2h_evt);
1726554c0a3aSHans de Goede continue;
1727554c0a3aSHans de Goede }
1728554c0a3aSHans de Goede
17298a6d92d7SKushal Kothari if (ccx_id_filter(c2h_evt)) {
1730554c0a3aSHans de Goede /* Handle CCX report here */
1731554c0a3aSHans de Goede rtw_hal_c2h_handler(adapter, c2h_evt);
1732554c0a3aSHans de Goede kfree(c2h_evt);
1733554c0a3aSHans de Goede } else {
1734554c0a3aSHans de Goede /* Enqueue into cmd_thread for others */
1735554c0a3aSHans de Goede rtw_c2h_wk_cmd(adapter, c2h_evt);
1736554c0a3aSHans de Goede }
1737554c0a3aSHans de Goede }
1738554c0a3aSHans de Goede
1739554c0a3aSHans de Goede evtpriv->c2h_wk_alive = false;
1740554c0a3aSHans de Goede }
1741554c0a3aSHans de Goede
rtw_drvextra_cmd_hdl(struct adapter * padapter,unsigned char * pbuf)1742554c0a3aSHans de Goede u8 rtw_drvextra_cmd_hdl(struct adapter *padapter, unsigned char *pbuf)
1743554c0a3aSHans de Goede {
1744554c0a3aSHans de Goede struct drvextra_cmd_parm *pdrvextra_cmd;
1745554c0a3aSHans de Goede
1746554c0a3aSHans de Goede if (!pbuf)
1747554c0a3aSHans de Goede return H2C_PARAMETERS_ERROR;
1748554c0a3aSHans de Goede
1749554c0a3aSHans de Goede pdrvextra_cmd = (struct drvextra_cmd_parm *)pbuf;
1750554c0a3aSHans de Goede
1751554c0a3aSHans de Goede switch (pdrvextra_cmd->ec_id) {
1752554c0a3aSHans de Goede case DYNAMIC_CHK_WK_CID:/* only primary padapter go to this cmd, but execute dynamic_chk_wk_hdl() for two interfaces */
1753554c0a3aSHans de Goede dynamic_chk_wk_hdl(padapter);
1754554c0a3aSHans de Goede break;
1755554c0a3aSHans de Goede case POWER_SAVING_CTRL_WK_CID:
1756534415d2SNishka Dasgupta rtw_ps_processor(padapter);
1757554c0a3aSHans de Goede break;
1758554c0a3aSHans de Goede case LPS_CTRL_WK_CID:
1759554c0a3aSHans de Goede lps_ctrl_wk_hdl(padapter, (u8)pdrvextra_cmd->type);
1760554c0a3aSHans de Goede break;
1761554c0a3aSHans de Goede case DM_IN_LPS_WK_CID:
1762554c0a3aSHans de Goede rtw_dm_in_lps_hdl(padapter);
1763554c0a3aSHans de Goede break;
1764554c0a3aSHans de Goede case LPS_CHANGE_DTIM_CID:
1765554c0a3aSHans de Goede rtw_lps_change_dtim_hdl(padapter, (u8)pdrvextra_cmd->type);
1766554c0a3aSHans de Goede break;
1767554c0a3aSHans de Goede case CHECK_HIQ_WK_CID:
1768554c0a3aSHans de Goede rtw_chk_hi_queue_hdl(padapter);
1769554c0a3aSHans de Goede break;
1770554c0a3aSHans de Goede /* add for CONFIG_IEEE80211W, none 11w can use it */
1771554c0a3aSHans de Goede case RESET_SECURITYPRIV:
1772534415d2SNishka Dasgupta rtw_reset_securitypriv(padapter);
1773554c0a3aSHans de Goede break;
1774554c0a3aSHans de Goede case FREE_ASSOC_RESOURCES:
1775534415d2SNishka Dasgupta rtw_free_assoc_resources(padapter, 1);
1776554c0a3aSHans de Goede break;
1777554c0a3aSHans de Goede case C2H_WK_CID:
1778554c0a3aSHans de Goede rtw_hal_set_hwreg_with_buf(padapter, HW_VAR_C2H_HANDLE, pdrvextra_cmd->pbuf, pdrvextra_cmd->size);
1779554c0a3aSHans de Goede break;
1780554c0a3aSHans de Goede case DM_RA_MSK_WK_CID:
1781554c0a3aSHans de Goede rtw_dm_ra_mask_hdl(padapter, (struct sta_info *)pdrvextra_cmd->pbuf);
1782554c0a3aSHans de Goede break;
1783554c0a3aSHans de Goede case BTINFO_WK_CID:
1784554c0a3aSHans de Goede rtw_btinfo_hdl(padapter, pdrvextra_cmd->pbuf, pdrvextra_cmd->size);
1785554c0a3aSHans de Goede break;
1786554c0a3aSHans de Goede default:
1787554c0a3aSHans de Goede break;
1788554c0a3aSHans de Goede }
1789554c0a3aSHans de Goede
17908f870aabSManuel Palenzuela if (pdrvextra_cmd->pbuf && pdrvextra_cmd->size > 0)
1791554c0a3aSHans de Goede kfree(pdrvextra_cmd->pbuf);
1792554c0a3aSHans de Goede
1793554c0a3aSHans de Goede return H2C_SUCCESS;
1794554c0a3aSHans de Goede }
1795554c0a3aSHans de Goede
rtw_survey_cmd_callback(struct adapter * padapter,struct cmd_obj * pcmd)1796554c0a3aSHans de Goede void rtw_survey_cmd_callback(struct adapter *padapter, struct cmd_obj *pcmd)
1797554c0a3aSHans de Goede {
1798554c0a3aSHans de Goede struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
1799554c0a3aSHans de Goede
1800f9ceb182SRebecca Mckeever if (pcmd->res != H2C_SUCCESS) {
1801554c0a3aSHans de Goede /* TODO: cancel timer and do timeout handler directly... */
1802554c0a3aSHans de Goede _set_timer(&pmlmepriv->scan_to_timer, 1);
1803554c0a3aSHans de Goede }
1804554c0a3aSHans de Goede
1805554c0a3aSHans de Goede /* free cmd */
1806554c0a3aSHans de Goede rtw_free_cmd_obj(pcmd);
1807554c0a3aSHans de Goede }
1808554c0a3aSHans de Goede
rtw_disassoc_cmd_callback(struct adapter * padapter,struct cmd_obj * pcmd)1809554c0a3aSHans de Goede void rtw_disassoc_cmd_callback(struct adapter *padapter, struct cmd_obj *pcmd)
1810554c0a3aSHans de Goede {
1811554c0a3aSHans de Goede struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
1812554c0a3aSHans de Goede
1813554c0a3aSHans de Goede if (pcmd->res != H2C_SUCCESS) {
1814554c0a3aSHans de Goede spin_lock_bh(&pmlmepriv->lock);
1815554c0a3aSHans de Goede set_fwstate(pmlmepriv, _FW_LINKED);
1816554c0a3aSHans de Goede spin_unlock_bh(&pmlmepriv->lock);
1817554c0a3aSHans de Goede
1818554c0a3aSHans de Goede return;
1819554c0a3aSHans de Goede }
1820554c0a3aSHans de Goede /* free cmd */
1821554c0a3aSHans de Goede rtw_free_cmd_obj(pcmd);
1822554c0a3aSHans de Goede }
1823554c0a3aSHans de Goede
rtw_joinbss_cmd_callback(struct adapter * padapter,struct cmd_obj * pcmd)1824554c0a3aSHans de Goede void rtw_joinbss_cmd_callback(struct adapter *padapter, struct cmd_obj *pcmd)
1825554c0a3aSHans de Goede {
1826554c0a3aSHans de Goede struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
1827554c0a3aSHans de Goede
1828f9ceb182SRebecca Mckeever if (pcmd->res != H2C_SUCCESS) {
1829554c0a3aSHans de Goede /* TODO: cancel timer and do timeout handler directly... */
1830554c0a3aSHans de Goede _set_timer(&pmlmepriv->assoc_timer, 1);
1831554c0a3aSHans de Goede }
1832554c0a3aSHans de Goede
1833554c0a3aSHans de Goede rtw_free_cmd_obj(pcmd);
1834554c0a3aSHans de Goede }
1835554c0a3aSHans de Goede
rtw_createbss_cmd_callback(struct adapter * padapter,struct cmd_obj * pcmd)1836554c0a3aSHans de Goede void rtw_createbss_cmd_callback(struct adapter *padapter, struct cmd_obj *pcmd)
1837554c0a3aSHans de Goede {
1838554c0a3aSHans de Goede struct sta_info *psta = NULL;
1839554c0a3aSHans de Goede struct wlan_network *pwlan = NULL;
1840554c0a3aSHans de Goede struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
1841554c0a3aSHans de Goede struct wlan_bssid_ex *pnetwork = (struct wlan_bssid_ex *)pcmd->parmbuf;
184253303e7aSKushal Kothari struct wlan_network *tgt_network = &pmlmepriv->cur_network;
1843554c0a3aSHans de Goede
1844cd1f1450SMichael Straube if (!pcmd->parmbuf)
1845554c0a3aSHans de Goede goto exit;
1846554c0a3aSHans de Goede
1847b7fd07b6SFabio Aiuto if (pcmd->res != H2C_SUCCESS)
1848554c0a3aSHans de Goede _set_timer(&pmlmepriv->assoc_timer, 1);
1849554c0a3aSHans de Goede
1850fb127a61SRoss Schmidt del_timer_sync(&pmlmepriv->assoc_timer);
1851554c0a3aSHans de Goede
1852554c0a3aSHans de Goede spin_lock_bh(&pmlmepriv->lock);
1853554c0a3aSHans de Goede
1854554c0a3aSHans de Goede
1855554c0a3aSHans de Goede if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) {
1856d3fcee1bSFabio Aiuto psta = rtw_get_stainfo(&padapter->stapriv, pnetwork->mac_address);
1857554c0a3aSHans de Goede if (!psta) {
1858d3fcee1bSFabio Aiuto psta = rtw_alloc_stainfo(&padapter->stapriv, pnetwork->mac_address);
185961e0d092SFabio Aiuto if (!psta)
1860554c0a3aSHans de Goede goto createbss_cmd_fail;
1861554c0a3aSHans de Goede }
1862554c0a3aSHans de Goede
1863554c0a3aSHans de Goede rtw_indicate_connect(padapter);
1864554c0a3aSHans de Goede } else {
18658e97f7d8SNishka Dasgupta pwlan = rtw_alloc_network(pmlmepriv);
186653303e7aSKushal Kothari spin_lock_bh(&pmlmepriv->scanned_queue.lock);
1867cd1f1450SMichael Straube if (!pwlan) {
1868554c0a3aSHans de Goede pwlan = rtw_get_oldest_wlan_network(&pmlmepriv->scanned_queue);
1869cd1f1450SMichael Straube if (!pwlan) {
187053303e7aSKushal Kothari spin_unlock_bh(&pmlmepriv->scanned_queue.lock);
1871554c0a3aSHans de Goede goto createbss_cmd_fail;
1872554c0a3aSHans de Goede }
1873554c0a3aSHans de Goede pwlan->last_scanned = jiffies;
1874554c0a3aSHans de Goede } else {
187553303e7aSKushal Kothari list_add_tail(&pwlan->list, &pmlmepriv->scanned_queue.queue);
1876554c0a3aSHans de Goede }
1877554c0a3aSHans de Goede
1878d3fcee1bSFabio Aiuto pnetwork->length = get_wlan_bssid_ex_sz(pnetwork);
187953303e7aSKushal Kothari memcpy(&pwlan->network, pnetwork, pnetwork->length);
1880554c0a3aSHans de Goede /* pwlan->fixed = true; */
1881554c0a3aSHans de Goede
1882554c0a3aSHans de Goede /* list_add_tail(&(pwlan->list), &pmlmepriv->scanned_queue.queue); */
1883554c0a3aSHans de Goede
1884554c0a3aSHans de Goede /* copy pdev_network information to pmlmepriv->cur_network */
1885554c0a3aSHans de Goede memcpy(&tgt_network->network, pnetwork, (get_wlan_bssid_ex_sz(pnetwork)));
1886554c0a3aSHans de Goede
1887d8b322b6SFabio Aiuto /* reset ds_config */
1888d8b322b6SFabio Aiuto /* tgt_network->network.configuration.ds_config = (u32)rtw_ch2freq(pnetwork->configuration.ds_config); */
1889554c0a3aSHans de Goede
1890554c0a3aSHans de Goede _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING);
1891554c0a3aSHans de Goede
189253303e7aSKushal Kothari spin_unlock_bh(&pmlmepriv->scanned_queue.lock);
1893554c0a3aSHans de Goede /* we will set _FW_LINKED when there is one more sat to join us (rtw_stassoc_event_callback) */
1894554c0a3aSHans de Goede
1895554c0a3aSHans de Goede }
1896554c0a3aSHans de Goede
1897554c0a3aSHans de Goede createbss_cmd_fail:
1898554c0a3aSHans de Goede
1899554c0a3aSHans de Goede spin_unlock_bh(&pmlmepriv->lock);
1900554c0a3aSHans de Goede exit:
1901554c0a3aSHans de Goede rtw_free_cmd_obj(pcmd);
1902554c0a3aSHans de Goede }
1903554c0a3aSHans de Goede
rtw_setstaKey_cmdrsp_callback(struct adapter * padapter,struct cmd_obj * pcmd)1904554c0a3aSHans de Goede void rtw_setstaKey_cmdrsp_callback(struct adapter *padapter, struct cmd_obj *pcmd)
1905554c0a3aSHans de Goede {
1906554c0a3aSHans de Goede struct sta_priv *pstapriv = &padapter->stapriv;
1907554c0a3aSHans de Goede struct set_stakey_rsp *psetstakey_rsp = (struct set_stakey_rsp *)(pcmd->rsp);
1908554c0a3aSHans de Goede struct sta_info *psta = rtw_get_stainfo(pstapriv, psetstakey_rsp->addr);
1909554c0a3aSHans de Goede
191061e0d092SFabio Aiuto if (!psta)
1911554c0a3aSHans de Goede goto exit;
191213aefa65SFabio Aiuto
1913554c0a3aSHans de Goede exit:
1914554c0a3aSHans de Goede rtw_free_cmd_obj(pcmd);
1915554c0a3aSHans de Goede }
1916554c0a3aSHans de Goede
rtw_setassocsta_cmdrsp_callback(struct adapter * padapter,struct cmd_obj * pcmd)1917554c0a3aSHans de Goede void rtw_setassocsta_cmdrsp_callback(struct adapter *padapter, struct cmd_obj *pcmd)
1918554c0a3aSHans de Goede {
1919554c0a3aSHans de Goede struct sta_priv *pstapriv = &padapter->stapriv;
1920554c0a3aSHans de Goede struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
1921554c0a3aSHans de Goede struct set_assocsta_parm *passocsta_parm = (struct set_assocsta_parm *)(pcmd->parmbuf);
1922554c0a3aSHans de Goede struct set_assocsta_rsp *passocsta_rsp = (struct set_assocsta_rsp *)(pcmd->rsp);
1923554c0a3aSHans de Goede struct sta_info *psta = rtw_get_stainfo(pstapriv, passocsta_parm->addr);
1924554c0a3aSHans de Goede
192561e0d092SFabio Aiuto if (!psta)
1926554c0a3aSHans de Goede goto exit;
1927554c0a3aSHans de Goede
1928c42a4ac4SSimran Singhal psta->aid = passocsta_rsp->cam_id;
1929c42a4ac4SSimran Singhal psta->mac_id = passocsta_rsp->cam_id;
1930554c0a3aSHans de Goede
1931554c0a3aSHans de Goede spin_lock_bh(&pmlmepriv->lock);
1932554c0a3aSHans de Goede
1933cf8f6446SKushal Kothari if (check_fwstate(pmlmepriv, WIFI_MP_STATE) && check_fwstate(pmlmepriv, _FW_UNDER_LINKING))
1934554c0a3aSHans de Goede _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING);
1935554c0a3aSHans de Goede
1936554c0a3aSHans de Goede set_fwstate(pmlmepriv, _FW_LINKED);
1937554c0a3aSHans de Goede spin_unlock_bh(&pmlmepriv->lock);
1938554c0a3aSHans de Goede
1939554c0a3aSHans de Goede exit:
1940554c0a3aSHans de Goede rtw_free_cmd_obj(pcmd);
1941554c0a3aSHans de Goede }
1942