1 /******************************************************************************
4 * Copyright(c) 2007 - 2010 Realtek Corporation. All rights reserved.
5 * Linux device driver for RTL8192SU
7 * This program is free software; you can redistribute it and/or modify it
8 * under the terms of version 2 of the GNU General Public License as
9 * published by the Free Software Foundation.
11 * This program is distributed in the hope that it will be useful, but WITHOUT
12 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
13 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
16 * You should have received a copy of the GNU General Public License along with
17 * this program; if not, write to the Free Software Foundation, Inc.,
18 * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
20 * Modifications for inclusion into the Linux staging tree are
21 * Copyright(c) 2010 Larry Finger. All rights reserved.
23 * Contact information:
24 * WLAN FAE <wlanfae@realtek.com>
25 * Larry Finger <Larry.Finger@lwfinger.net>
27 ******************************************************************************/
29 #define _RTL871X_CMD_C_
31 #include <linux/compiler.h>
32 #include <linux/kernel.h>
33 #include <linux/errno.h>
34 #include <linux/slab.h>
35 #include <linux/module.h>
36 #include <linux/kref.h>
37 #include <linux/netdevice.h>
38 #include <linux/skbuff.h>
39 #include <linux/usb.h>
40 #include <linux/usb/ch9.h>
41 #include <linux/circ_buf.h>
42 #include <linux/uaccess.h>
43 #include <asm/byteorder.h>
44 #include <linux/atomic.h>
45 #include <linux/semaphore.h>
46 #include <linux/rtnetlink.h>
48 #include "osdep_service.h"
49 #include "drv_types.h"
50 #include "recv_osdep.h"
51 #include "mlme_osdep.h"
54 Caller and the r8712_cmd_thread can protect cmd_q by spin_lock.
55 No irqsave is necessary.
58 static sint _init_cmd_priv(struct cmd_priv *pcmdpriv)
60 sema_init(&(pcmdpriv->cmd_queue_sema), 0);
61 sema_init(&(pcmdpriv->terminate_cmdthread_sema), 0);
63 _init_queue(&(pcmdpriv->cmd_queue));
65 /* allocate DMA-able/Non-Page memory for cmd_buf and rsp_buf */
66 pcmdpriv->cmd_seq = 1;
67 pcmdpriv->cmd_allocated_buf = _malloc(MAX_CMDSZ + CMDBUFF_ALIGN_SZ);
68 if (pcmdpriv->cmd_allocated_buf == NULL)
70 pcmdpriv->cmd_buf = pcmdpriv->cmd_allocated_buf + CMDBUFF_ALIGN_SZ -
71 ((addr_t)(pcmdpriv->cmd_allocated_buf) &
72 (CMDBUFF_ALIGN_SZ-1));
73 pcmdpriv->rsp_allocated_buf = _malloc(MAX_RSPSZ + 4);
74 if (pcmdpriv->rsp_allocated_buf == NULL)
76 pcmdpriv->rsp_buf = pcmdpriv->rsp_allocated_buf + 4 -
77 ((addr_t)(pcmdpriv->rsp_allocated_buf) & 3);
78 pcmdpriv->cmd_issued_cnt = 0;
79 pcmdpriv->cmd_done_cnt = 0;
80 pcmdpriv->rsp_cnt = 0;
84 static sint _init_evt_priv(struct evt_priv *pevtpriv)
86 /* allocate DMA-able/Non-Page memory for cmd_buf and rsp_buf */
87 pevtpriv->event_seq = 0;
88 pevtpriv->evt_allocated_buf = _malloc(MAX_EVTSZ + 4);
90 if (pevtpriv->evt_allocated_buf == NULL)
92 pevtpriv->evt_buf = pevtpriv->evt_allocated_buf + 4 -
93 ((addr_t)(pevtpriv->evt_allocated_buf) & 3);
94 pevtpriv->evt_done_cnt = 0;
98 static void _free_evt_priv(struct evt_priv *pevtpriv)
100 kfree(pevtpriv->evt_allocated_buf);
103 static void _free_cmd_priv(struct cmd_priv *pcmdpriv)
106 kfree(pcmdpriv->cmd_allocated_buf);
107 kfree(pcmdpriv->rsp_allocated_buf);
114 _enqueue_cmd can only be called between kernel thread,
115 since only spin_lock is used.
117 ISR/Call-Back functions can't call this sub-function.
121 static sint _enqueue_cmd(struct __queue *queue, struct cmd_obj *obj)
127 spin_lock_irqsave(&queue->lock, irqL);
128 list_insert_tail(&obj->list, &queue->queue);
129 spin_unlock_irqrestore(&queue->lock, irqL);
133 static struct cmd_obj *_dequeue_cmd(struct __queue *queue)
138 spin_lock_irqsave(&(queue->lock), irqL);
139 if (is_list_empty(&(queue->queue)))
142 obj = LIST_CONTAINOR(get_next(&(queue->queue)),
143 struct cmd_obj, list);
144 list_delete(&obj->list);
146 spin_unlock_irqrestore(&(queue->lock), irqL);
150 u32 r8712_init_cmd_priv(struct cmd_priv *pcmdpriv)
152 return _init_cmd_priv(pcmdpriv);
155 u32 r8712_init_evt_priv(struct evt_priv *pevtpriv)
157 return _init_evt_priv(pevtpriv);
160 void r8712_free_evt_priv(struct evt_priv *pevtpriv)
162 _free_evt_priv(pevtpriv);
165 void r8712_free_cmd_priv(struct cmd_priv *pcmdpriv)
167 _free_cmd_priv(pcmdpriv);
170 u32 r8712_enqueue_cmd(struct cmd_priv *pcmdpriv, struct cmd_obj *obj)
174 if (pcmdpriv->padapter->eeprompriv.bautoload_fail_flag == true)
176 res = _enqueue_cmd(&pcmdpriv->cmd_queue, obj);
177 up(&pcmdpriv->cmd_queue_sema);
181 u32 r8712_enqueue_cmd_ex(struct cmd_priv *pcmdpriv, struct cmd_obj *obj)
184 struct __queue *queue;
188 if (pcmdpriv->padapter->eeprompriv.bautoload_fail_flag == true)
190 queue = &pcmdpriv->cmd_queue;
191 spin_lock_irqsave(&queue->lock, irqL);
192 list_insert_tail(&obj->list, &queue->queue);
193 spin_unlock_irqrestore(&queue->lock, irqL);
194 up(&pcmdpriv->cmd_queue_sema);
198 struct cmd_obj *r8712_dequeue_cmd(struct __queue *queue)
200 return _dequeue_cmd(queue);
203 void r8712_free_cmd_obj(struct cmd_obj *pcmd)
205 if ((pcmd->cmdcode != _JoinBss_CMD_) &&
206 (pcmd->cmdcode != _CreateBss_CMD_))
207 kfree((unsigned char *)pcmd->parmbuf);
208 if (pcmd->rsp != NULL) {
209 if (pcmd->rspsz != 0)
210 kfree((unsigned char *)pcmd->rsp);
212 kfree((unsigned char *)pcmd);
216 r8712_sitesurvey_cmd(~)
218 MUST TAKE CARE THAT BEFORE CALLING THIS FUNC,
219 YOU SHOULD HAVE LOCKED pmlmepriv->lock
221 u8 r8712_sitesurvey_cmd(struct _adapter *padapter,
222 struct ndis_802_11_ssid *pssid)
224 struct cmd_obj *ph2c;
225 struct sitesurvey_parm *psurveyPara;
226 struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
227 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
229 ph2c = (struct cmd_obj *)_malloc(sizeof(struct cmd_obj));
232 psurveyPara = (struct sitesurvey_parm *)_malloc(
233 sizeof(struct sitesurvey_parm));
234 if (psurveyPara == NULL) {
235 kfree((unsigned char *) ph2c);
238 init_h2fwcmd_w_parm_no_rsp(ph2c, psurveyPara,
239 GEN_CMD_CODE(_SiteSurvey));
240 psurveyPara->bsslimit = cpu_to_le32(48);
241 psurveyPara->passive_mode = cpu_to_le32(pmlmepriv->passive_mode);
242 psurveyPara->ss_ssidlen = 0;
243 memset(psurveyPara->ss_ssid, 0, IW_ESSID_MAX_SIZE + 1);
244 if ((pssid != NULL) && (pssid->SsidLength)) {
245 memcpy(psurveyPara->ss_ssid, pssid->Ssid, pssid->SsidLength);
246 psurveyPara->ss_ssidlen = cpu_to_le32(pssid->SsidLength);
248 set_fwstate(pmlmepriv, _FW_UNDER_SURVEY);
249 r8712_enqueue_cmd(pcmdpriv, ph2c);
250 _set_timer(&pmlmepriv->scan_to_timer, SCANNING_TIMEOUT);
251 padapter->ledpriv.LedControlHandler(padapter, LED_CTL_SITE_SURVEY);
252 padapter->blnEnableRxFF0Filter = 0;
256 u8 r8712_setdatarate_cmd(struct _adapter *padapter, u8 *rateset)
258 struct cmd_obj *ph2c;
259 struct setdatarate_parm *pbsetdataratepara;
260 struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
262 ph2c = (struct cmd_obj *)_malloc(sizeof(struct cmd_obj));
265 pbsetdataratepara = (struct setdatarate_parm *)_malloc(
266 sizeof(struct setdatarate_parm));
267 if (pbsetdataratepara == NULL) {
271 init_h2fwcmd_w_parm_no_rsp(ph2c, pbsetdataratepara,
272 GEN_CMD_CODE(_SetDataRate));
273 pbsetdataratepara->mac_id = 5;
274 memcpy(pbsetdataratepara->datarates, rateset, NumRates);
275 r8712_enqueue_cmd(pcmdpriv, ph2c);
279 u8 r8712_set_chplan_cmd(struct _adapter *padapter, int chplan)
281 struct cmd_obj *ph2c;
282 struct SetChannelPlan_param *psetchplanpara;
283 struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
285 ph2c = (struct cmd_obj *)_malloc(sizeof(struct cmd_obj));
288 psetchplanpara = (struct SetChannelPlan_param *)
289 _malloc(sizeof(struct SetChannelPlan_param));
290 if (psetchplanpara == NULL) {
294 init_h2fwcmd_w_parm_no_rsp(ph2c, psetchplanpara,
295 GEN_CMD_CODE(_SetChannelPlan));
296 psetchplanpara->ChannelPlan = chplan;
297 r8712_enqueue_cmd(pcmdpriv, ph2c);
301 u8 r8712_setbasicrate_cmd(struct _adapter *padapter, u8 *rateset)
303 struct cmd_obj *ph2c;
304 struct setbasicrate_parm *pssetbasicratepara;
305 struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
307 ph2c = (struct cmd_obj *)_malloc(sizeof(struct cmd_obj));
310 pssetbasicratepara = (struct setbasicrate_parm *)_malloc(
311 sizeof(struct setbasicrate_parm));
312 if (pssetbasicratepara == NULL) {
316 init_h2fwcmd_w_parm_no_rsp(ph2c, pssetbasicratepara,
318 memcpy(pssetbasicratepara->basicrates, rateset, NumRates);
319 r8712_enqueue_cmd(pcmdpriv, ph2c);
323 /* power tracking mechanism setting */
324 u8 r8712_setptm_cmd(struct _adapter *padapter, u8 type)
326 struct cmd_obj *ph2c;
327 struct writePTM_parm *pwriteptmparm;
328 struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
330 ph2c = (struct cmd_obj *)_malloc(sizeof(struct cmd_obj));
333 pwriteptmparm = (struct writePTM_parm *)
334 _malloc(sizeof(struct writePTM_parm));
335 if (pwriteptmparm == NULL) {
339 init_h2fwcmd_w_parm_no_rsp(ph2c, pwriteptmparm, GEN_CMD_CODE(_SetPT));
340 pwriteptmparm->type = type;
341 r8712_enqueue_cmd(pcmdpriv, ph2c);
345 u8 r8712_setfwdig_cmd(struct _adapter *padapter, u8 type)
347 struct cmd_obj *ph2c;
348 struct writePTM_parm *pwriteptmparm;
349 struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
351 ph2c = (struct cmd_obj *)_malloc(sizeof(struct cmd_obj));
354 pwriteptmparm = (struct writePTM_parm *)
355 _malloc(sizeof(struct setdig_parm));
356 if (pwriteptmparm == NULL) {
360 init_h2fwcmd_w_parm_no_rsp(ph2c, pwriteptmparm, GEN_CMD_CODE(_SetDIG));
361 pwriteptmparm->type = type;
362 r8712_enqueue_cmd(pcmdpriv, ph2c);
366 u8 r8712_setfwra_cmd(struct _adapter *padapter, u8 type)
368 struct cmd_obj *ph2c;
369 struct writePTM_parm *pwriteptmparm;
370 struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
372 ph2c = (struct cmd_obj *)_malloc(sizeof(struct cmd_obj));
375 pwriteptmparm = (struct writePTM_parm *)
376 _malloc(sizeof(struct setra_parm));
377 if (pwriteptmparm == NULL) {
381 init_h2fwcmd_w_parm_no_rsp(ph2c, pwriteptmparm, GEN_CMD_CODE(_SetRA));
382 pwriteptmparm->type = type;
383 r8712_enqueue_cmd(pcmdpriv, ph2c);
387 u8 r8712_setrfreg_cmd(struct _adapter *padapter, u8 offset, u32 val)
389 struct cmd_obj *ph2c;
390 struct writeRF_parm *pwriterfparm;
391 struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
393 ph2c = (struct cmd_obj *)_malloc(sizeof(struct cmd_obj));
396 pwriterfparm = (struct writeRF_parm *)_malloc(
397 sizeof(struct writeRF_parm));
398 if (pwriterfparm == NULL) {
402 init_h2fwcmd_w_parm_no_rsp(ph2c, pwriterfparm, GEN_CMD_CODE(_SetRFReg));
403 pwriterfparm->offset = offset;
404 pwriterfparm->value = val;
405 r8712_enqueue_cmd(pcmdpriv, ph2c);
409 u8 r8712_getrfreg_cmd(struct _adapter *padapter, u8 offset, u8 *pval)
411 struct cmd_obj *ph2c;
412 struct readRF_parm *prdrfparm;
413 struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
415 ph2c = (struct cmd_obj *)_malloc(sizeof(struct cmd_obj));
418 prdrfparm = (struct readRF_parm *)_malloc(sizeof(struct readRF_parm));
419 if (prdrfparm == NULL) {
423 _init_listhead(&ph2c->list);
424 ph2c->cmdcode = GEN_CMD_CODE(_GetRFReg);
425 ph2c->parmbuf = (unsigned char *)prdrfparm;
426 ph2c->cmdsz = sizeof(struct readRF_parm);
428 ph2c->rspsz = sizeof(struct readRF_rsp);
429 prdrfparm->offset = offset;
430 r8712_enqueue_cmd(pcmdpriv, ph2c);
434 void r8712_getbbrfreg_cmdrsp_callback(struct _adapter *padapter,
435 struct cmd_obj *pcmd)
437 kfree(pcmd->parmbuf);
439 padapter->mppriv.workparam.bcompleted = true;
442 void r8712_readtssi_cmdrsp_callback(struct _adapter *padapter,
443 struct cmd_obj *pcmd)
445 kfree(pcmd->parmbuf);
448 padapter->mppriv.workparam.bcompleted = true;
451 u8 r8712_createbss_cmd(struct _adapter *padapter)
453 struct cmd_obj *pcmd;
454 struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
455 struct wlan_bssid_ex *pdev_network =
456 &padapter->registrypriv.dev_network;
458 padapter->ledpriv.LedControlHandler(padapter, LED_CTL_START_TO_LINK);
459 pcmd = (struct cmd_obj *)_malloc(sizeof(struct cmd_obj));
462 _init_listhead(&pcmd->list);
463 pcmd->cmdcode = _CreateBss_CMD_;
464 pcmd->parmbuf = (unsigned char *)pdev_network;
465 pcmd->cmdsz = r8712_get_ndis_wlan_bssid_ex_sz((
466 struct ndis_wlan_bssid_ex *)
470 /* notes: translate IELength & Length after assign to cmdsz; */
471 pdev_network->Length = pcmd->cmdsz;
472 pdev_network->IELength = pdev_network->IELength;
473 pdev_network->Ssid.SsidLength = pdev_network->Ssid.SsidLength;
474 r8712_enqueue_cmd(pcmdpriv, pcmd);
478 u8 r8712_joinbss_cmd(struct _adapter *padapter, struct wlan_network *pnetwork)
482 struct ndis_wlan_bssid_ex *psecnetwork;
483 struct cmd_obj *pcmd;
484 struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
485 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
486 struct qos_priv *pqospriv = &pmlmepriv->qospriv;
487 struct security_priv *psecuritypriv = &padapter->securitypriv;
488 struct registry_priv *pregistrypriv = &padapter->registrypriv;
489 enum NDIS_802_11_NETWORK_INFRASTRUCTURE ndis_network_mode = pnetwork->
490 network.InfrastructureMode;
492 padapter->ledpriv.LedControlHandler(padapter, LED_CTL_START_TO_LINK);
493 pcmd = (struct cmd_obj *)_malloc(sizeof(struct cmd_obj));
496 t_len = sizeof(u32) + 6 * sizeof(unsigned char) + 2 +
497 sizeof(struct ndis_802_11_ssid) + sizeof(u32) +
499 sizeof(enum NDIS_802_11_NETWORK_TYPE) +
500 sizeof(struct NDIS_802_11_CONFIGURATION) +
501 sizeof(enum NDIS_802_11_NETWORK_INFRASTRUCTURE) +
502 sizeof(NDIS_802_11_RATES_EX) +
503 sizeof(u32) + MAX_IE_SZ;
505 /* for hidden ap to set fw_state here */
506 if (check_fwstate(pmlmepriv, WIFI_STATION_STATE|WIFI_ADHOC_STATE) !=
508 switch (ndis_network_mode) {
510 pmlmepriv->fw_state |= WIFI_ADHOC_STATE;
512 case Ndis802_11Infrastructure:
513 pmlmepriv->fw_state |= WIFI_STATION_STATE;
515 case Ndis802_11APMode:
516 case Ndis802_11AutoUnknown:
517 case Ndis802_11InfrastructureMax:
521 psecnetwork = (struct ndis_wlan_bssid_ex *)&psecuritypriv->sec_bss;
522 if (psecnetwork == NULL) {
526 memcpy(psecnetwork, &pnetwork->network, t_len);
527 auth = &psecuritypriv->authenticator_ie[0];
528 psecuritypriv->authenticator_ie[0] = (unsigned char)
529 psecnetwork->IELength;
530 if ((psecnetwork->IELength-12) < (256 - 1))
531 memcpy(&psecuritypriv->authenticator_ie[1],
532 &psecnetwork->IEs[12], psecnetwork->IELength-12);
534 memcpy(&psecuritypriv->authenticator_ie[1],
535 &psecnetwork->IEs[12], (256-1));
536 psecnetwork->IELength = 0;
537 /* If the the driver wants to use the bssid to create the connection.
538 * If not, we copy the connecting AP's MAC address to it so that
539 * the driver just has the bssid information for PMKIDList searching.
541 if (pmlmepriv->assoc_by_bssid == false)
542 memcpy(&pmlmepriv->assoc_bssid[0],
543 &pnetwork->network.MacAddress[0], ETH_ALEN);
544 psecnetwork->IELength = r8712_restruct_sec_ie(padapter,
545 &pnetwork->network.IEs[0],
546 &psecnetwork->IEs[0],
547 pnetwork->network.IELength);
548 pqospriv->qos_option = 0;
549 if (pregistrypriv->wmm_enable) {
552 tmp_len = r8712_restruct_wmm_ie(padapter,
553 &pnetwork->network.IEs[0],
554 &psecnetwork->IEs[0],
555 pnetwork->network.IELength,
556 psecnetwork->IELength);
557 if (psecnetwork->IELength != tmp_len) {
558 psecnetwork->IELength = tmp_len;
559 pqospriv->qos_option = 1; /* WMM IE in beacon */
561 pqospriv->qos_option = 0; /* no WMM IE in beacon */
563 if (pregistrypriv->ht_enable) {
564 /* For WEP mode, we will use the bg mode to do the connection
565 * to avoid some IOT issues, especially for Realtek 8192u
568 if ((padapter->securitypriv.PrivacyAlgrthm != _WEP40_) &&
569 (padapter->securitypriv.PrivacyAlgrthm != _WEP104_)) {
570 /* restructure_ht_ie */
571 r8712_restructure_ht_ie(padapter,
572 &pnetwork->network.IEs[0],
573 &psecnetwork->IEs[0],
574 pnetwork->network.IELength,
575 &psecnetwork->IELength);
578 psecuritypriv->supplicant_ie[0] = (u8)psecnetwork->IELength;
579 if (psecnetwork->IELength < 255)
580 memcpy(&psecuritypriv->supplicant_ie[1], &psecnetwork->IEs[0],
581 psecnetwork->IELength);
583 memcpy(&psecuritypriv->supplicant_ie[1], &psecnetwork->IEs[0],
585 /* get cmdsz before endian conversion */
586 pcmd->cmdsz = r8712_get_ndis_wlan_bssid_ex_sz(psecnetwork);
588 /* wlan_network endian conversion */
589 psecnetwork->Length = cpu_to_le32(psecnetwork->Length);
590 psecnetwork->Ssid.SsidLength = cpu_to_le32(
591 psecnetwork->Ssid.SsidLength);
592 psecnetwork->Privacy = cpu_to_le32(psecnetwork->Privacy);
593 psecnetwork->Rssi = cpu_to_le32(psecnetwork->Rssi);
594 psecnetwork->NetworkTypeInUse = cpu_to_le32(
595 psecnetwork->NetworkTypeInUse);
596 psecnetwork->Configuration.ATIMWindow = cpu_to_le32(
597 psecnetwork->Configuration.ATIMWindow);
598 psecnetwork->Configuration.BeaconPeriod = cpu_to_le32(
599 psecnetwork->Configuration.BeaconPeriod);
600 psecnetwork->Configuration.DSConfig = cpu_to_le32(
601 psecnetwork->Configuration.DSConfig);
602 psecnetwork->Configuration.FHConfig.DwellTime = cpu_to_le32(
603 psecnetwork->Configuration.FHConfig.DwellTime);
604 psecnetwork->Configuration.FHConfig.HopPattern = cpu_to_le32(
605 psecnetwork->Configuration.FHConfig.HopPattern);
606 psecnetwork->Configuration.FHConfig.HopSet = cpu_to_le32(
607 psecnetwork->Configuration.FHConfig.HopSet);
608 psecnetwork->Configuration.FHConfig.Length = cpu_to_le32(
609 psecnetwork->Configuration.FHConfig.Length);
610 psecnetwork->Configuration.Length = cpu_to_le32(
611 psecnetwork->Configuration.Length);
612 psecnetwork->InfrastructureMode = cpu_to_le32(
613 psecnetwork->InfrastructureMode);
614 psecnetwork->IELength = cpu_to_le32(psecnetwork->IELength);
616 _init_listhead(&pcmd->list);
617 pcmd->cmdcode = _JoinBss_CMD_;
618 pcmd->parmbuf = (unsigned char *)psecnetwork;
621 r8712_enqueue_cmd(pcmdpriv, pcmd);
625 u8 r8712_disassoc_cmd(struct _adapter *padapter) /* for sta_mode */
627 struct cmd_obj *pdisconnect_cmd;
628 struct disconnect_parm *pdisconnect;
629 struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
631 pdisconnect_cmd = (struct cmd_obj *)_malloc(sizeof(struct cmd_obj));
632 if (pdisconnect_cmd == NULL)
634 pdisconnect = (struct disconnect_parm *)_malloc(
635 sizeof(struct disconnect_parm));
636 if (pdisconnect == NULL) {
637 kfree((u8 *)pdisconnect_cmd);
640 init_h2fwcmd_w_parm_no_rsp(pdisconnect_cmd, pdisconnect,
642 r8712_enqueue_cmd(pcmdpriv, pdisconnect_cmd);
646 u8 r8712_setopmode_cmd(struct _adapter *padapter,
647 enum NDIS_802_11_NETWORK_INFRASTRUCTURE networktype)
649 struct cmd_obj *ph2c;
650 struct setopmode_parm *psetop;
652 struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
654 ph2c = (struct cmd_obj *)_malloc(sizeof(struct cmd_obj));
657 psetop = (struct setopmode_parm *)_malloc(
658 sizeof(struct setopmode_parm));
659 if (psetop == NULL) {
663 init_h2fwcmd_w_parm_no_rsp(ph2c, psetop, _SetOpMode_CMD_);
664 psetop->mode = (u8)networktype;
665 r8712_enqueue_cmd(pcmdpriv, ph2c);
669 u8 r8712_setstakey_cmd(struct _adapter *padapter, u8 *psta, u8 unicast_key)
671 struct cmd_obj *ph2c;
672 struct set_stakey_parm *psetstakey_para;
673 struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
674 struct set_stakey_rsp *psetstakey_rsp = NULL;
675 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
676 struct security_priv *psecuritypriv = &padapter->securitypriv;
677 struct sta_info *sta = (struct sta_info *)psta;
679 ph2c = (struct cmd_obj *)_malloc(sizeof(struct cmd_obj));
682 psetstakey_para = (struct set_stakey_parm *)_malloc(
683 sizeof(struct set_stakey_parm));
684 if (psetstakey_para == NULL) {
688 psetstakey_rsp = (struct set_stakey_rsp *)_malloc(
689 sizeof(struct set_stakey_rsp));
690 if (psetstakey_rsp == NULL) {
692 kfree((u8 *) psetstakey_para);
695 init_h2fwcmd_w_parm_no_rsp(ph2c, psetstakey_para, _SetStaKey_CMD_);
696 ph2c->rsp = (u8 *) psetstakey_rsp;
697 ph2c->rspsz = sizeof(struct set_stakey_rsp);
698 memcpy(psetstakey_para->addr, sta->hwaddr, ETH_ALEN);
699 if (check_fwstate(pmlmepriv, WIFI_STATION_STATE))
700 psetstakey_para->algorithm = (unsigned char)
701 psecuritypriv->PrivacyAlgrthm;
703 GET_ENCRY_ALGO(psecuritypriv, sta,
704 psetstakey_para->algorithm, false);
705 if (unicast_key == true)
706 memcpy(&psetstakey_para->key, &sta->x_UncstKey, 16);
708 memcpy(&psetstakey_para->key,
709 &psecuritypriv->XGrpKey[
710 psecuritypriv->XGrpKeyid - 1]. skey, 16);
711 r8712_enqueue_cmd(pcmdpriv, ph2c);
715 u8 r8712_setrfintfs_cmd(struct _adapter *padapter, u8 mode)
717 struct cmd_obj *ph2c;
718 struct setrfintfs_parm *psetrfintfsparm;
719 struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
721 ph2c = (struct cmd_obj *)_malloc(sizeof(struct cmd_obj));
724 psetrfintfsparm = (struct setrfintfs_parm *)_malloc(
725 sizeof(struct setrfintfs_parm));
726 if (psetrfintfsparm == NULL) {
727 kfree((unsigned char *) ph2c);
730 init_h2fwcmd_w_parm_no_rsp(ph2c, psetrfintfsparm,
731 GEN_CMD_CODE(_SetRFIntFs));
732 psetrfintfsparm->rfintfs = mode;
733 r8712_enqueue_cmd(pcmdpriv, ph2c);
737 u8 r8712_setrttbl_cmd(struct _adapter *padapter,
738 struct setratable_parm *prate_table)
740 struct cmd_obj *ph2c;
741 struct setratable_parm *psetrttblparm;
742 struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
744 ph2c = (struct cmd_obj *)_malloc(sizeof(struct cmd_obj));
747 psetrttblparm = (struct setratable_parm *)_malloc(
748 sizeof(struct setratable_parm));
749 if (psetrttblparm == NULL) {
750 kfree((unsigned char *)ph2c);
753 init_h2fwcmd_w_parm_no_rsp(ph2c, psetrttblparm,
754 GEN_CMD_CODE(_SetRaTable));
755 memcpy(psetrttblparm, prate_table, sizeof(struct setratable_parm));
756 r8712_enqueue_cmd(pcmdpriv, ph2c);
760 u8 r8712_gettssi_cmd(struct _adapter *padapter, u8 offset, u8 *pval)
762 struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
763 struct cmd_obj *ph2c;
764 struct readTSSI_parm *prdtssiparm;
766 ph2c = (struct cmd_obj *)_malloc(sizeof(struct cmd_obj));
769 prdtssiparm = (struct readTSSI_parm *)
770 _malloc(sizeof(struct readTSSI_parm));
771 if (prdtssiparm == NULL) {
772 kfree((unsigned char *) ph2c);
775 _init_listhead(&ph2c->list);
776 ph2c->cmdcode = GEN_CMD_CODE(_ReadTSSI);
777 ph2c->parmbuf = (unsigned char *)prdtssiparm;
778 ph2c->cmdsz = sizeof(struct readTSSI_parm);
780 ph2c->rspsz = sizeof(struct readTSSI_rsp);
782 prdtssiparm->offset = offset;
783 r8712_enqueue_cmd(pcmdpriv, ph2c);
787 u8 r8712_setMacAddr_cmd(struct _adapter *padapter, u8 *mac_addr)
789 struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
790 struct cmd_obj *ph2c;
791 struct SetMacAddr_param *psetMacAddr_para;
793 ph2c = (struct cmd_obj *)_malloc(sizeof(struct cmd_obj));
796 psetMacAddr_para = (struct SetMacAddr_param *)_malloc(
797 sizeof(struct SetMacAddr_param));
798 if (psetMacAddr_para == NULL) {
802 init_h2fwcmd_w_parm_no_rsp(ph2c, psetMacAddr_para,
803 _SetMacAddress_CMD_);
804 memcpy(psetMacAddr_para->MacAddr, mac_addr, ETH_ALEN);
805 r8712_enqueue_cmd(pcmdpriv, ph2c);
809 u8 r8712_setassocsta_cmd(struct _adapter *padapter, u8 *mac_addr)
811 struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
812 struct cmd_obj *ph2c;
813 struct set_assocsta_parm *psetassocsta_para;
814 struct set_assocsta_rsp *psetassocsta_rsp = NULL;
816 ph2c = (struct cmd_obj *)_malloc(sizeof(struct cmd_obj));
819 psetassocsta_para = (struct set_assocsta_parm *)
820 _malloc(sizeof(struct set_assocsta_parm));
821 if (psetassocsta_para == NULL) {
825 psetassocsta_rsp = (struct set_assocsta_rsp *)_malloc(
826 sizeof(struct set_assocsta_rsp));
827 if (psetassocsta_rsp == NULL) {
829 kfree((u8 *)psetassocsta_para);
832 init_h2fwcmd_w_parm_no_rsp(ph2c, psetassocsta_para, _SetAssocSta_CMD_);
833 ph2c->rsp = (u8 *) psetassocsta_rsp;
834 ph2c->rspsz = sizeof(struct set_assocsta_rsp);
835 memcpy(psetassocsta_para->addr, mac_addr, ETH_ALEN);
836 r8712_enqueue_cmd(pcmdpriv, ph2c);
840 u8 r8712_addbareq_cmd(struct _adapter *padapter, u8 tid)
842 struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
843 struct cmd_obj *ph2c;
844 struct addBaReq_parm *paddbareq_parm;
846 ph2c = (struct cmd_obj *)_malloc(sizeof(struct cmd_obj));
849 paddbareq_parm = (struct addBaReq_parm *)_malloc(
850 sizeof(struct addBaReq_parm));
851 if (paddbareq_parm == NULL) {
852 kfree((unsigned char *)ph2c);
855 paddbareq_parm->tid = tid;
856 init_h2fwcmd_w_parm_no_rsp(ph2c, paddbareq_parm,
857 GEN_CMD_CODE(_AddBAReq));
858 r8712_enqueue_cmd_ex(pcmdpriv, ph2c);
862 u8 r8712_wdg_wk_cmd(struct _adapter *padapter)
864 struct cmd_obj *ph2c;
865 struct drvint_cmd_parm *pdrvintcmd_param;
866 struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
868 ph2c = (struct cmd_obj *)_malloc(sizeof(struct cmd_obj));
871 pdrvintcmd_param = (struct drvint_cmd_parm *)_malloc(
872 sizeof(struct drvint_cmd_parm));
873 if (pdrvintcmd_param == NULL) {
874 kfree((unsigned char *)ph2c);
877 pdrvintcmd_param->i_cid = WDG_WK_CID;
878 pdrvintcmd_param->sz = 0;
879 pdrvintcmd_param->pbuf = NULL;
880 init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvintcmd_param, _DRV_INT_CMD_);
881 r8712_enqueue_cmd_ex(pcmdpriv, ph2c);
885 void r8712_survey_cmd_callback(struct _adapter *padapter, struct cmd_obj *pcmd)
887 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
889 if (pcmd->res != H2C_SUCCESS)
890 clr_fwstate(pmlmepriv, _FW_UNDER_SURVEY);
891 r8712_free_cmd_obj(pcmd);
894 void r8712_disassoc_cmd_callback(struct _adapter *padapter,
895 struct cmd_obj *pcmd)
898 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
900 if (pcmd->res != H2C_SUCCESS) {
901 spin_lock_irqsave(&pmlmepriv->lock, irqL);
902 set_fwstate(pmlmepriv, _FW_LINKED);
903 spin_unlock_irqrestore(&pmlmepriv->lock, irqL);
906 r8712_free_cmd_obj(pcmd);
909 void r8712_joinbss_cmd_callback(struct _adapter *padapter, struct cmd_obj *pcmd)
911 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
913 if (pcmd->res != H2C_SUCCESS)
914 _set_timer(&pmlmepriv->assoc_timer, 1);
915 r8712_free_cmd_obj(pcmd);
918 void r8712_createbss_cmd_callback(struct _adapter *padapter,
919 struct cmd_obj *pcmd)
923 struct sta_info *psta = NULL;
924 struct wlan_network *pwlan = NULL;
925 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
926 struct ndis_wlan_bssid_ex *pnetwork = (struct ndis_wlan_bssid_ex *)
928 struct wlan_network *tgt_network = &(pmlmepriv->cur_network);
930 if (pcmd->res != H2C_SUCCESS)
931 _set_timer(&pmlmepriv->assoc_timer, 1);
932 _cancel_timer(&pmlmepriv->assoc_timer, &timer_cancelled);
935 pnetwork->Length = le32_to_cpu(pnetwork->Length);
936 pnetwork->Ssid.SsidLength = le32_to_cpu(pnetwork->Ssid.SsidLength);
937 pnetwork->Privacy = le32_to_cpu(pnetwork->Privacy);
938 pnetwork->Rssi = le32_to_cpu(pnetwork->Rssi);
939 pnetwork->NetworkTypeInUse = le32_to_cpu(pnetwork->NetworkTypeInUse);
940 pnetwork->Configuration.ATIMWindow = le32_to_cpu(pnetwork->
941 Configuration.ATIMWindow);
942 pnetwork->Configuration.DSConfig = le32_to_cpu(pnetwork->
943 Configuration.DSConfig);
944 pnetwork->Configuration.FHConfig.DwellTime = le32_to_cpu(pnetwork->
945 Configuration.FHConfig.DwellTime);
946 pnetwork->Configuration.FHConfig.HopPattern = le32_to_cpu(pnetwork->
947 Configuration.FHConfig.HopPattern);
948 pnetwork->Configuration.FHConfig.HopSet = le32_to_cpu(pnetwork->
949 Configuration.FHConfig.HopSet);
950 pnetwork->Configuration.FHConfig.Length = le32_to_cpu(pnetwork->
951 Configuration.FHConfig.Length);
952 pnetwork->Configuration.Length = le32_to_cpu(pnetwork->
953 Configuration.Length);
954 pnetwork->InfrastructureMode = le32_to_cpu(pnetwork->
956 pnetwork->IELength = le32_to_cpu(pnetwork->IELength);
958 spin_lock_irqsave(&pmlmepriv->lock, irqL);
959 if ((pmlmepriv->fw_state) & WIFI_AP_STATE) {
960 psta = r8712_get_stainfo(&padapter->stapriv,
961 pnetwork->MacAddress);
963 psta = r8712_alloc_stainfo(&padapter->stapriv,
964 pnetwork->MacAddress);
966 goto createbss_cmd_fail;
968 r8712_indicate_connect(padapter);
970 pwlan = _r8712_alloc_network(pmlmepriv);
972 pwlan = r8712_get_oldest_wlan_network(
973 &pmlmepriv->scanned_queue);
975 goto createbss_cmd_fail;
976 pwlan->last_scanned = jiffies;
978 list_insert_tail(&(pwlan->list),
979 &pmlmepriv->scanned_queue.queue);
980 pnetwork->Length = r8712_get_ndis_wlan_bssid_ex_sz(pnetwork);
981 memcpy(&(pwlan->network), pnetwork, pnetwork->Length);
983 memcpy(&tgt_network->network, pnetwork,
984 (r8712_get_ndis_wlan_bssid_ex_sz(pnetwork)));
985 if (pmlmepriv->fw_state & _FW_UNDER_LINKING)
986 pmlmepriv->fw_state ^= _FW_UNDER_LINKING;
987 /* we will set _FW_LINKED when there is one more sat to
988 * join us (stassoc_event_callback) */
991 spin_unlock_irqrestore(&pmlmepriv->lock, irqL);
992 r8712_free_cmd_obj(pcmd);
995 void r8712_setstaKey_cmdrsp_callback(struct _adapter *padapter,
996 struct cmd_obj *pcmd)
998 struct sta_priv *pstapriv = &padapter->stapriv;
999 struct set_stakey_rsp *psetstakey_rsp = (struct set_stakey_rsp *)
1001 struct sta_info *psta = r8712_get_stainfo(pstapriv,
1002 psetstakey_rsp->addr);
1006 psta->aid = psta->mac_id = psetstakey_rsp->keyid; /*CAM_ID(CAM_ENTRY)*/
1008 r8712_free_cmd_obj(pcmd);
1011 void r8712_setassocsta_cmdrsp_callback(struct _adapter *padapter,
1012 struct cmd_obj *pcmd)
1015 struct sta_priv *pstapriv = &padapter->stapriv;
1016 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
1017 struct set_assocsta_parm *passocsta_parm =
1018 (struct set_assocsta_parm *)(pcmd->parmbuf);
1019 struct set_assocsta_rsp *passocsta_rsp =
1020 (struct set_assocsta_rsp *) (pcmd->rsp);
1021 struct sta_info *psta = r8712_get_stainfo(pstapriv,
1022 passocsta_parm->addr);
1026 psta->aid = psta->mac_id = passocsta_rsp->cam_id;
1027 spin_lock_irqsave(&pmlmepriv->lock, irqL);
1028 if ((check_fwstate(pmlmepriv, WIFI_MP_STATE)) &&
1029 (check_fwstate(pmlmepriv, _FW_UNDER_LINKING)))
1030 pmlmepriv->fw_state ^= _FW_UNDER_LINKING;
1031 set_fwstate(pmlmepriv, _FW_LINKED);
1032 spin_unlock_irqrestore(&pmlmepriv->lock, irqL);
1033 r8712_free_cmd_obj(pcmd);
1036 u8 r8712_disconnectCtrlEx_cmd(struct _adapter *adapter, u32 enableDrvCtrl,
1037 u32 tryPktCnt, u32 tryPktInterval, u32 firstStageTO)
1039 struct cmd_obj *ph2c;
1040 struct DisconnectCtrlEx_param *param;
1041 struct cmd_priv *pcmdpriv = &adapter->cmdpriv;
1043 ph2c = (struct cmd_obj *)_malloc(sizeof(struct cmd_obj));
1046 param = (struct DisconnectCtrlEx_param *)
1047 _malloc(sizeof(struct DisconnectCtrlEx_param));
1048 if (param == NULL) {
1049 kfree((unsigned char *) ph2c);
1052 memset(param, 0, sizeof(struct DisconnectCtrlEx_param));
1054 param->EnableDrvCtrl = (unsigned char)enableDrvCtrl;
1055 param->TryPktCnt = (unsigned char)tryPktCnt;
1056 param->TryPktInterval = (unsigned char)tryPktInterval;
1057 param->FirstStageTO = (unsigned int)firstStageTO;
1059 init_h2fwcmd_w_parm_no_rsp(ph2c, param,
1060 GEN_CMD_CODE(_DisconnectCtrlEx));
1061 r8712_enqueue_cmd(pcmdpriv, ph2c);