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/init.h>
35 #include <linux/slab.h>
36 #include <linux/module.h>
37 #include <linux/kref.h>
38 #include <linux/netdevice.h>
39 #include <linux/skbuff.h>
40 #include <linux/usb.h>
41 #include <linux/usb/ch9.h>
42 #include <linux/circ_buf.h>
43 #include <linux/uaccess.h>
44 #include <asm/byteorder.h>
45 #include <linux/atomic.h>
46 #include <linux/semaphore.h>
47 #include <linux/rtnetlink.h>
49 #include "osdep_service.h"
50 #include "drv_types.h"
51 #include "recv_osdep.h"
52 #include "mlme_osdep.h"
55 Caller and the r8712_cmd_thread can protect cmd_q by spin_lock.
56 No irqsave is necessary.
59 static sint _init_cmd_priv(struct cmd_priv *pcmdpriv)
61 sema_init(&(pcmdpriv->cmd_queue_sema), 0);
62 sema_init(&(pcmdpriv->terminate_cmdthread_sema), 0);
64 _init_queue(&(pcmdpriv->cmd_queue));
66 /* allocate DMA-able/Non-Page memory for cmd_buf and rsp_buf */
67 pcmdpriv->cmd_seq = 1;
68 pcmdpriv->cmd_allocated_buf = _malloc(MAX_CMDSZ + CMDBUFF_ALIGN_SZ);
69 if (pcmdpriv->cmd_allocated_buf == NULL)
71 pcmdpriv->cmd_buf = pcmdpriv->cmd_allocated_buf + CMDBUFF_ALIGN_SZ -
72 ((addr_t)(pcmdpriv->cmd_allocated_buf) &
73 (CMDBUFF_ALIGN_SZ-1));
74 pcmdpriv->rsp_allocated_buf = _malloc(MAX_RSPSZ + 4);
75 if (pcmdpriv->rsp_allocated_buf == NULL)
77 pcmdpriv->rsp_buf = pcmdpriv->rsp_allocated_buf + 4 -
78 ((addr_t)(pcmdpriv->rsp_allocated_buf) & 3);
79 pcmdpriv->cmd_issued_cnt = 0;
80 pcmdpriv->cmd_done_cnt = 0;
81 pcmdpriv->rsp_cnt = 0;
85 static sint _init_evt_priv(struct evt_priv *pevtpriv)
87 /* allocate DMA-able/Non-Page memory for cmd_buf and rsp_buf */
88 pevtpriv->event_seq = 0;
89 pevtpriv->evt_allocated_buf = _malloc(MAX_EVTSZ + 4);
91 if (pevtpriv->evt_allocated_buf == NULL)
93 pevtpriv->evt_buf = pevtpriv->evt_allocated_buf + 4 -
94 ((addr_t)(pevtpriv->evt_allocated_buf) & 3);
95 pevtpriv->evt_done_cnt = 0;
99 static void _free_evt_priv(struct evt_priv *pevtpriv)
101 kfree(pevtpriv->evt_allocated_buf);
104 static void _free_cmd_priv(struct cmd_priv *pcmdpriv)
107 kfree(pcmdpriv->cmd_allocated_buf);
108 kfree(pcmdpriv->rsp_allocated_buf);
115 _enqueue_cmd can only be called between kernel thread,
116 since only spin_lock is used.
118 ISR/Call-Back functions can't call this sub-function.
122 static sint _enqueue_cmd(struct __queue *queue, struct cmd_obj *obj)
128 spin_lock_irqsave(&queue->lock, irqL);
129 list_insert_tail(&obj->list, &queue->queue);
130 spin_unlock_irqrestore(&queue->lock, irqL);
134 static struct cmd_obj *_dequeue_cmd(struct __queue *queue)
139 spin_lock_irqsave(&(queue->lock), irqL);
140 if (is_list_empty(&(queue->queue)))
143 obj = LIST_CONTAINOR(get_next(&(queue->queue)),
144 struct cmd_obj, list);
145 list_delete(&obj->list);
147 spin_unlock_irqrestore(&(queue->lock), irqL);
151 u32 r8712_init_cmd_priv(struct cmd_priv *pcmdpriv)
153 return _init_cmd_priv(pcmdpriv);
156 u32 r8712_init_evt_priv(struct evt_priv *pevtpriv)
158 return _init_evt_priv(pevtpriv);
161 void r8712_free_evt_priv(struct evt_priv *pevtpriv)
163 _free_evt_priv(pevtpriv);
166 void r8712_free_cmd_priv(struct cmd_priv *pcmdpriv)
168 _free_cmd_priv(pcmdpriv);
171 u32 r8712_enqueue_cmd(struct cmd_priv *pcmdpriv, struct cmd_obj *obj)
175 if (pcmdpriv->padapter->eeprompriv.bautoload_fail_flag == true)
177 res = _enqueue_cmd(&pcmdpriv->cmd_queue, obj);
178 up(&pcmdpriv->cmd_queue_sema);
182 u32 r8712_enqueue_cmd_ex(struct cmd_priv *pcmdpriv, struct cmd_obj *obj)
185 struct __queue *queue;
189 if (pcmdpriv->padapter->eeprompriv.bautoload_fail_flag == true)
191 queue = &pcmdpriv->cmd_queue;
192 spin_lock_irqsave(&queue->lock, irqL);
193 list_insert_tail(&obj->list, &queue->queue);
194 spin_unlock_irqrestore(&queue->lock, irqL);
195 up(&pcmdpriv->cmd_queue_sema);
199 struct cmd_obj *r8712_dequeue_cmd(struct __queue *queue)
201 return _dequeue_cmd(queue);
204 void r8712_free_cmd_obj(struct cmd_obj *pcmd)
206 if ((pcmd->cmdcode != _JoinBss_CMD_) &&
207 (pcmd->cmdcode != _CreateBss_CMD_))
208 kfree((unsigned char *)pcmd->parmbuf);
209 if (pcmd->rsp != NULL) {
210 if (pcmd->rspsz != 0)
211 kfree((unsigned char *)pcmd->rsp);
213 kfree((unsigned char *)pcmd);
217 r8712_sitesurvey_cmd(~)
219 MUST TAKE CARE THAT BEFORE CALLING THIS FUNC,
220 YOU SHOULD HAVE LOCKED pmlmepriv->lock
222 u8 r8712_sitesurvey_cmd(struct _adapter *padapter,
223 struct ndis_802_11_ssid *pssid)
225 struct cmd_obj *ph2c;
226 struct sitesurvey_parm *psurveyPara;
227 struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
228 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
230 ph2c = (struct cmd_obj *)_malloc(sizeof(struct cmd_obj));
233 psurveyPara = (struct sitesurvey_parm *)_malloc(
234 sizeof(struct sitesurvey_parm));
235 if (psurveyPara == NULL) {
236 kfree((unsigned char *) ph2c);
239 init_h2fwcmd_w_parm_no_rsp(ph2c, psurveyPara,
240 GEN_CMD_CODE(_SiteSurvey));
241 psurveyPara->bsslimit = cpu_to_le32(48);
242 psurveyPara->passive_mode = cpu_to_le32(pmlmepriv->passive_mode);
243 psurveyPara->ss_ssidlen = 0;
244 memset(psurveyPara->ss_ssid, 0, IW_ESSID_MAX_SIZE + 1);
245 if ((pssid != NULL) && (pssid->SsidLength)) {
246 memcpy(psurveyPara->ss_ssid, pssid->Ssid, pssid->SsidLength);
247 psurveyPara->ss_ssidlen = cpu_to_le32(pssid->SsidLength);
249 set_fwstate(pmlmepriv, _FW_UNDER_SURVEY);
250 r8712_enqueue_cmd(pcmdpriv, ph2c);
251 _set_timer(&pmlmepriv->scan_to_timer, SCANNING_TIMEOUT);
252 padapter->ledpriv.LedControlHandler(padapter, LED_CTL_SITE_SURVEY);
253 padapter->blnEnableRxFF0Filter = 0;
257 u8 r8712_setdatarate_cmd(struct _adapter *padapter, u8 *rateset)
259 struct cmd_obj *ph2c;
260 struct setdatarate_parm *pbsetdataratepara;
261 struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
263 ph2c = (struct cmd_obj *)_malloc(sizeof(struct cmd_obj));
266 pbsetdataratepara = (struct setdatarate_parm *)_malloc(
267 sizeof(struct setdatarate_parm));
268 if (pbsetdataratepara == NULL) {
272 init_h2fwcmd_w_parm_no_rsp(ph2c, pbsetdataratepara,
273 GEN_CMD_CODE(_SetDataRate));
274 pbsetdataratepara->mac_id = 5;
275 memcpy(pbsetdataratepara->datarates, rateset, NumRates);
276 r8712_enqueue_cmd(pcmdpriv, ph2c);
280 u8 r8712_set_chplan_cmd(struct _adapter *padapter, int chplan)
282 struct cmd_obj *ph2c;
283 struct SetChannelPlan_param *psetchplanpara;
284 struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
286 ph2c = (struct cmd_obj *)_malloc(sizeof(struct cmd_obj));
289 psetchplanpara = (struct SetChannelPlan_param *)
290 _malloc(sizeof(struct SetChannelPlan_param));
291 if (psetchplanpara == NULL) {
295 init_h2fwcmd_w_parm_no_rsp(ph2c, psetchplanpara,
296 GEN_CMD_CODE(_SetChannelPlan));
297 psetchplanpara->ChannelPlan = chplan;
298 r8712_enqueue_cmd(pcmdpriv, ph2c);
302 u8 r8712_setbasicrate_cmd(struct _adapter *padapter, u8 *rateset)
304 struct cmd_obj *ph2c;
305 struct setbasicrate_parm *pssetbasicratepara;
306 struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
308 ph2c = (struct cmd_obj *)_malloc(sizeof(struct cmd_obj));
311 pssetbasicratepara = (struct setbasicrate_parm *)_malloc(
312 sizeof(struct setbasicrate_parm));
313 if (pssetbasicratepara == NULL) {
317 init_h2fwcmd_w_parm_no_rsp(ph2c, pssetbasicratepara,
319 memcpy(pssetbasicratepara->basicrates, rateset, NumRates);
320 r8712_enqueue_cmd(pcmdpriv, ph2c);
324 /* power tracking mechanism setting */
325 u8 r8712_setptm_cmd(struct _adapter *padapter, u8 type)
327 struct cmd_obj *ph2c;
328 struct writePTM_parm *pwriteptmparm;
329 struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
331 ph2c = (struct cmd_obj *)_malloc(sizeof(struct cmd_obj));
334 pwriteptmparm = (struct writePTM_parm *)
335 _malloc(sizeof(struct writePTM_parm));
336 if (pwriteptmparm == NULL) {
340 init_h2fwcmd_w_parm_no_rsp(ph2c, pwriteptmparm, GEN_CMD_CODE(_SetPT));
341 pwriteptmparm->type = type;
342 r8712_enqueue_cmd(pcmdpriv, ph2c);
346 u8 r8712_setfwdig_cmd(struct _adapter *padapter, u8 type)
348 struct cmd_obj *ph2c;
349 struct writePTM_parm *pwriteptmparm;
350 struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
352 ph2c = (struct cmd_obj *)_malloc(sizeof(struct cmd_obj));
355 pwriteptmparm = (struct writePTM_parm *)
356 _malloc(sizeof(struct setdig_parm));
357 if (pwriteptmparm == NULL) {
361 init_h2fwcmd_w_parm_no_rsp(ph2c, pwriteptmparm, GEN_CMD_CODE(_SetDIG));
362 pwriteptmparm->type = type;
363 r8712_enqueue_cmd(pcmdpriv, ph2c);
367 u8 r8712_setfwra_cmd(struct _adapter *padapter, u8 type)
369 struct cmd_obj *ph2c;
370 struct writePTM_parm *pwriteptmparm;
371 struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
373 ph2c = (struct cmd_obj *)_malloc(sizeof(struct cmd_obj));
376 pwriteptmparm = (struct writePTM_parm *)
377 _malloc(sizeof(struct setra_parm));
378 if (pwriteptmparm == NULL) {
382 init_h2fwcmd_w_parm_no_rsp(ph2c, pwriteptmparm, GEN_CMD_CODE(_SetRA));
383 pwriteptmparm->type = type;
384 r8712_enqueue_cmd(pcmdpriv, ph2c);
388 u8 r8712_setrfreg_cmd(struct _adapter *padapter, u8 offset, u32 val)
390 struct cmd_obj *ph2c;
391 struct writeRF_parm *pwriterfparm;
392 struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
394 ph2c = (struct cmd_obj *)_malloc(sizeof(struct cmd_obj));
397 pwriterfparm = (struct writeRF_parm *)_malloc(
398 sizeof(struct writeRF_parm));
399 if (pwriterfparm == NULL) {
403 init_h2fwcmd_w_parm_no_rsp(ph2c, pwriterfparm, GEN_CMD_CODE(_SetRFReg));
404 pwriterfparm->offset = offset;
405 pwriterfparm->value = val;
406 r8712_enqueue_cmd(pcmdpriv, ph2c);
410 u8 r8712_getrfreg_cmd(struct _adapter *padapter, u8 offset, u8 *pval)
412 struct cmd_obj *ph2c;
413 struct readRF_parm *prdrfparm;
414 struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
416 ph2c = (struct cmd_obj *)_malloc(sizeof(struct cmd_obj));
419 prdrfparm = (struct readRF_parm *)_malloc(sizeof(struct readRF_parm));
420 if (prdrfparm == NULL) {
424 _init_listhead(&ph2c->list);
425 ph2c->cmdcode = GEN_CMD_CODE(_GetRFReg);
426 ph2c->parmbuf = (unsigned char *)prdrfparm;
427 ph2c->cmdsz = sizeof(struct readRF_parm);
429 ph2c->rspsz = sizeof(struct readRF_rsp);
430 prdrfparm->offset = offset;
431 r8712_enqueue_cmd(pcmdpriv, ph2c);
435 void r8712_getbbrfreg_cmdrsp_callback(struct _adapter *padapter,
436 struct cmd_obj *pcmd)
438 kfree(pcmd->parmbuf);
440 padapter->mppriv.workparam.bcompleted = true;
443 void r8712_readtssi_cmdrsp_callback(struct _adapter *padapter,
444 struct cmd_obj *pcmd)
446 kfree(pcmd->parmbuf);
449 padapter->mppriv.workparam.bcompleted = true;
452 u8 r8712_createbss_cmd(struct _adapter *padapter)
454 struct cmd_obj *pcmd;
455 struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
456 struct wlan_bssid_ex *pdev_network =
457 &padapter->registrypriv.dev_network;
459 padapter->ledpriv.LedControlHandler(padapter, LED_CTL_START_TO_LINK);
460 pcmd = (struct cmd_obj *)_malloc(sizeof(struct cmd_obj));
463 _init_listhead(&pcmd->list);
464 pcmd->cmdcode = _CreateBss_CMD_;
465 pcmd->parmbuf = (unsigned char *)pdev_network;
466 pcmd->cmdsz = r8712_get_ndis_wlan_bssid_ex_sz((
467 struct ndis_wlan_bssid_ex *)
471 /* notes: translate IELength & Length after assign to cmdsz; */
472 pdev_network->Length = cpu_to_le32(pcmd->cmdsz);
473 pdev_network->IELength = cpu_to_le32(pdev_network->IELength);
474 pdev_network->Ssid.SsidLength = cpu_to_le32(
475 pdev_network->Ssid.SsidLength);
476 r8712_enqueue_cmd(pcmdpriv, pcmd);
480 u8 r8712_joinbss_cmd(struct _adapter *padapter, struct wlan_network *pnetwork)
484 struct ndis_wlan_bssid_ex *psecnetwork;
485 struct cmd_obj *pcmd;
486 struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
487 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
488 struct qos_priv *pqospriv = &pmlmepriv->qospriv;
489 struct security_priv *psecuritypriv = &padapter->securitypriv;
490 struct registry_priv *pregistrypriv = &padapter->registrypriv;
491 enum NDIS_802_11_NETWORK_INFRASTRUCTURE ndis_network_mode = pnetwork->
492 network.InfrastructureMode;
494 padapter->ledpriv.LedControlHandler(padapter, LED_CTL_START_TO_LINK);
495 pcmd = (struct cmd_obj *)_malloc(sizeof(struct cmd_obj));
498 t_len = sizeof(u32) + 6 * sizeof(unsigned char) + 2 +
499 sizeof(struct ndis_802_11_ssid) + sizeof(u32) +
501 sizeof(enum NDIS_802_11_NETWORK_TYPE) +
502 sizeof(struct NDIS_802_11_CONFIGURATION) +
503 sizeof(enum NDIS_802_11_NETWORK_INFRASTRUCTURE) +
504 sizeof(NDIS_802_11_RATES_EX) +
505 sizeof(u32) + MAX_IE_SZ;
507 /* for hidden ap to set fw_state here */
508 if (check_fwstate(pmlmepriv, WIFI_STATION_STATE|WIFI_ADHOC_STATE) !=
510 switch (ndis_network_mode) {
512 pmlmepriv->fw_state |= WIFI_ADHOC_STATE;
514 case Ndis802_11Infrastructure:
515 pmlmepriv->fw_state |= WIFI_STATION_STATE;
517 case Ndis802_11APMode:
518 case Ndis802_11AutoUnknown:
519 case Ndis802_11InfrastructureMax:
523 psecnetwork = (struct ndis_wlan_bssid_ex *)&psecuritypriv->sec_bss;
524 if (psecnetwork == NULL) {
528 memset(psecnetwork, 0, t_len);
529 memcpy(psecnetwork, &pnetwork->network, t_len);
530 auth = &psecuritypriv->authenticator_ie[0];
531 psecuritypriv->authenticator_ie[0] = (unsigned char)
532 psecnetwork->IELength;
533 if ((psecnetwork->IELength-12) < (256 - 1))
534 memcpy(&psecuritypriv->authenticator_ie[1],
535 &psecnetwork->IEs[12], psecnetwork->IELength-12);
537 memcpy(&psecuritypriv->authenticator_ie[1],
538 &psecnetwork->IEs[12], (256-1));
539 psecnetwork->IELength = 0;
540 /* If the the driver wants to use the bssid to create the connection.
541 * If not, we copy the connecting AP's MAC address to it so that
542 * the driver just has the bssid information for PMKIDList searching.
544 if (pmlmepriv->assoc_by_bssid == false)
545 memcpy(&pmlmepriv->assoc_bssid[0],
546 &pnetwork->network.MacAddress[0], ETH_ALEN);
547 psecnetwork->IELength = r8712_restruct_sec_ie(padapter,
548 &pnetwork->network.IEs[0],
549 &psecnetwork->IEs[0],
550 pnetwork->network.IELength);
551 pqospriv->qos_option = 0;
552 if (pregistrypriv->wmm_enable) {
555 tmp_len = r8712_restruct_wmm_ie(padapter,
556 &pnetwork->network.IEs[0],
557 &psecnetwork->IEs[0],
558 pnetwork->network.IELength,
559 psecnetwork->IELength);
560 if (psecnetwork->IELength != tmp_len) {
561 psecnetwork->IELength = tmp_len;
562 pqospriv->qos_option = 1; /* WMM IE in beacon */
564 pqospriv->qos_option = 0; /* no WMM IE in beacon */
566 if (pregistrypriv->ht_enable) {
567 /* For WEP mode, we will use the bg mode to do the connection
568 * to avoid some IOT issues, especially for Realtek 8192u
571 if ((padapter->securitypriv.PrivacyAlgrthm != _WEP40_) &&
572 (padapter->securitypriv.PrivacyAlgrthm != _WEP104_)) {
573 /* restructure_ht_ie */
574 r8712_restructure_ht_ie(padapter,
575 &pnetwork->network.IEs[0],
576 &psecnetwork->IEs[0],
577 pnetwork->network.IELength,
578 &psecnetwork->IELength);
581 psecuritypriv->supplicant_ie[0] = (u8)psecnetwork->IELength;
582 if (psecnetwork->IELength < 255)
583 memcpy(&psecuritypriv->supplicant_ie[1], &psecnetwork->IEs[0],
584 psecnetwork->IELength);
586 memcpy(&psecuritypriv->supplicant_ie[1], &psecnetwork->IEs[0],
588 /* get cmdsz before endian conversion */
589 pcmd->cmdsz = r8712_get_ndis_wlan_bssid_ex_sz(psecnetwork);
591 /* wlan_network endian conversion */
592 psecnetwork->Length = cpu_to_le32(psecnetwork->Length);
593 psecnetwork->Ssid.SsidLength = cpu_to_le32(
594 psecnetwork->Ssid.SsidLength);
595 psecnetwork->Privacy = cpu_to_le32(psecnetwork->Privacy);
596 psecnetwork->Rssi = cpu_to_le32(psecnetwork->Rssi);
597 psecnetwork->NetworkTypeInUse = cpu_to_le32(
598 psecnetwork->NetworkTypeInUse);
599 psecnetwork->Configuration.ATIMWindow = cpu_to_le32(
600 psecnetwork->Configuration.ATIMWindow);
601 psecnetwork->Configuration.BeaconPeriod = cpu_to_le32(
602 psecnetwork->Configuration.BeaconPeriod);
603 psecnetwork->Configuration.DSConfig = cpu_to_le32(
604 psecnetwork->Configuration.DSConfig);
605 psecnetwork->Configuration.FHConfig.DwellTime = cpu_to_le32(
606 psecnetwork->Configuration.FHConfig.DwellTime);
607 psecnetwork->Configuration.FHConfig.HopPattern = cpu_to_le32(
608 psecnetwork->Configuration.FHConfig.HopPattern);
609 psecnetwork->Configuration.FHConfig.HopSet = cpu_to_le32(
610 psecnetwork->Configuration.FHConfig.HopSet);
611 psecnetwork->Configuration.FHConfig.Length = cpu_to_le32(
612 psecnetwork->Configuration.FHConfig.Length);
613 psecnetwork->Configuration.Length = cpu_to_le32(
614 psecnetwork->Configuration.Length);
615 psecnetwork->InfrastructureMode = cpu_to_le32(
616 psecnetwork->InfrastructureMode);
617 psecnetwork->IELength = cpu_to_le32(psecnetwork->IELength);
619 _init_listhead(&pcmd->list);
620 pcmd->cmdcode = _JoinBss_CMD_;
621 pcmd->parmbuf = (unsigned char *)psecnetwork;
624 r8712_enqueue_cmd(pcmdpriv, pcmd);
628 u8 r8712_disassoc_cmd(struct _adapter *padapter) /* for sta_mode */
630 struct cmd_obj *pdisconnect_cmd;
631 struct disconnect_parm *pdisconnect;
632 struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
634 pdisconnect_cmd = (struct cmd_obj *)_malloc(sizeof(struct cmd_obj));
635 if (pdisconnect_cmd == NULL)
637 pdisconnect = (struct disconnect_parm *)_malloc(
638 sizeof(struct disconnect_parm));
639 if (pdisconnect == NULL) {
640 kfree((u8 *)pdisconnect_cmd);
643 init_h2fwcmd_w_parm_no_rsp(pdisconnect_cmd, pdisconnect,
645 r8712_enqueue_cmd(pcmdpriv, pdisconnect_cmd);
649 u8 r8712_setopmode_cmd(struct _adapter *padapter,
650 enum NDIS_802_11_NETWORK_INFRASTRUCTURE networktype)
652 struct cmd_obj *ph2c;
653 struct setopmode_parm *psetop;
655 struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
657 ph2c = (struct cmd_obj *)_malloc(sizeof(struct cmd_obj));
660 psetop = (struct setopmode_parm *)_malloc(
661 sizeof(struct setopmode_parm));
662 if (psetop == NULL) {
666 init_h2fwcmd_w_parm_no_rsp(ph2c, psetop, _SetOpMode_CMD_);
667 psetop->mode = (u8)networktype;
668 r8712_enqueue_cmd(pcmdpriv, ph2c);
672 u8 r8712_setstakey_cmd(struct _adapter *padapter, u8 *psta, u8 unicast_key)
674 struct cmd_obj *ph2c;
675 struct set_stakey_parm *psetstakey_para;
676 struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
677 struct set_stakey_rsp *psetstakey_rsp = NULL;
678 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
679 struct security_priv *psecuritypriv = &padapter->securitypriv;
680 struct sta_info *sta = (struct sta_info *)psta;
682 ph2c = (struct cmd_obj *)_malloc(sizeof(struct cmd_obj));
685 psetstakey_para = (struct set_stakey_parm *)_malloc(
686 sizeof(struct set_stakey_parm));
687 if (psetstakey_para == NULL) {
691 psetstakey_rsp = (struct set_stakey_rsp *)_malloc(
692 sizeof(struct set_stakey_rsp));
693 if (psetstakey_rsp == NULL) {
695 kfree((u8 *) psetstakey_para);
698 init_h2fwcmd_w_parm_no_rsp(ph2c, psetstakey_para, _SetStaKey_CMD_);
699 ph2c->rsp = (u8 *) psetstakey_rsp;
700 ph2c->rspsz = sizeof(struct set_stakey_rsp);
701 memcpy(psetstakey_para->addr, sta->hwaddr, ETH_ALEN);
702 if (check_fwstate(pmlmepriv, WIFI_STATION_STATE))
703 psetstakey_para->algorithm = (unsigned char)
704 psecuritypriv->PrivacyAlgrthm;
706 GET_ENCRY_ALGO(psecuritypriv, sta,
707 psetstakey_para->algorithm, false);
708 if (unicast_key == true)
709 memcpy(&psetstakey_para->key, &sta->x_UncstKey, 16);
711 memcpy(&psetstakey_para->key,
712 &psecuritypriv->XGrpKey[
713 psecuritypriv->XGrpKeyid - 1]. skey, 16);
714 r8712_enqueue_cmd(pcmdpriv, ph2c);
718 u8 r8712_setrfintfs_cmd(struct _adapter *padapter, u8 mode)
720 struct cmd_obj *ph2c;
721 struct setrfintfs_parm *psetrfintfsparm;
722 struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
724 ph2c = (struct cmd_obj *)_malloc(sizeof(struct cmd_obj));
727 psetrfintfsparm = (struct setrfintfs_parm *)_malloc(
728 sizeof(struct setrfintfs_parm));
729 if (psetrfintfsparm == NULL) {
730 kfree((unsigned char *) ph2c);
733 init_h2fwcmd_w_parm_no_rsp(ph2c, psetrfintfsparm,
734 GEN_CMD_CODE(_SetRFIntFs));
735 psetrfintfsparm->rfintfs = mode;
736 r8712_enqueue_cmd(pcmdpriv, ph2c);
740 u8 r8712_setrttbl_cmd(struct _adapter *padapter,
741 struct setratable_parm *prate_table)
743 struct cmd_obj *ph2c;
744 struct setratable_parm *psetrttblparm;
745 struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
747 ph2c = (struct cmd_obj *)_malloc(sizeof(struct cmd_obj));
750 psetrttblparm = (struct setratable_parm *)_malloc(
751 sizeof(struct setratable_parm));
752 if (psetrttblparm == NULL) {
753 kfree((unsigned char *)ph2c);
756 init_h2fwcmd_w_parm_no_rsp(ph2c, psetrttblparm,
757 GEN_CMD_CODE(_SetRaTable));
758 memcpy(psetrttblparm, prate_table, sizeof(struct setratable_parm));
759 r8712_enqueue_cmd(pcmdpriv, ph2c);
763 u8 r8712_gettssi_cmd(struct _adapter *padapter, u8 offset, u8 *pval)
765 struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
766 struct cmd_obj *ph2c;
767 struct readTSSI_parm *prdtssiparm;
769 ph2c = (struct cmd_obj *)_malloc(sizeof(struct cmd_obj));
772 prdtssiparm = (struct readTSSI_parm *)
773 _malloc(sizeof(struct readTSSI_parm));
774 if (prdtssiparm == NULL) {
775 kfree((unsigned char *) ph2c);
778 _init_listhead(&ph2c->list);
779 ph2c->cmdcode = GEN_CMD_CODE(_ReadTSSI);
780 ph2c->parmbuf = (unsigned char *)prdtssiparm;
781 ph2c->cmdsz = sizeof(struct readTSSI_parm);
783 ph2c->rspsz = sizeof(struct readTSSI_rsp);
785 prdtssiparm->offset = offset;
786 r8712_enqueue_cmd(pcmdpriv, ph2c);
790 u8 r8712_setMacAddr_cmd(struct _adapter *padapter, u8 *mac_addr)
792 struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
793 struct cmd_obj *ph2c;
794 struct SetMacAddr_param *psetMacAddr_para;
796 ph2c = (struct cmd_obj *)_malloc(sizeof(struct cmd_obj));
799 psetMacAddr_para = (struct SetMacAddr_param *)_malloc(
800 sizeof(struct SetMacAddr_param));
801 if (psetMacAddr_para == NULL) {
805 init_h2fwcmd_w_parm_no_rsp(ph2c, psetMacAddr_para,
806 _SetMacAddress_CMD_);
807 memcpy(psetMacAddr_para->MacAddr, mac_addr, ETH_ALEN);
808 r8712_enqueue_cmd(pcmdpriv, ph2c);
812 u8 r8712_setassocsta_cmd(struct _adapter *padapter, u8 *mac_addr)
814 struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
815 struct cmd_obj *ph2c;
816 struct set_assocsta_parm *psetassocsta_para;
817 struct set_assocsta_rsp *psetassocsta_rsp = NULL;
819 ph2c = (struct cmd_obj *)_malloc(sizeof(struct cmd_obj));
822 psetassocsta_para = (struct set_assocsta_parm *)
823 _malloc(sizeof(struct set_assocsta_parm));
824 if (psetassocsta_para == NULL) {
828 psetassocsta_rsp = (struct set_assocsta_rsp *)_malloc(
829 sizeof(struct set_assocsta_rsp));
830 if (psetassocsta_rsp == NULL) {
832 kfree((u8 *)psetassocsta_para);
835 init_h2fwcmd_w_parm_no_rsp(ph2c, psetassocsta_para, _SetAssocSta_CMD_);
836 ph2c->rsp = (u8 *) psetassocsta_rsp;
837 ph2c->rspsz = sizeof(struct set_assocsta_rsp);
838 memcpy(psetassocsta_para->addr, mac_addr, ETH_ALEN);
839 r8712_enqueue_cmd(pcmdpriv, ph2c);
843 u8 r8712_addbareq_cmd(struct _adapter *padapter, u8 tid)
845 struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
846 struct cmd_obj *ph2c;
847 struct addBaReq_parm *paddbareq_parm;
849 ph2c = (struct cmd_obj *)_malloc(sizeof(struct cmd_obj));
852 paddbareq_parm = (struct addBaReq_parm *)_malloc(
853 sizeof(struct addBaReq_parm));
854 if (paddbareq_parm == NULL) {
855 kfree((unsigned char *)ph2c);
858 paddbareq_parm->tid = tid;
859 init_h2fwcmd_w_parm_no_rsp(ph2c, paddbareq_parm,
860 GEN_CMD_CODE(_AddBAReq));
861 r8712_enqueue_cmd_ex(pcmdpriv, ph2c);
865 u8 r8712_wdg_wk_cmd(struct _adapter *padapter)
867 struct cmd_obj *ph2c;
868 struct drvint_cmd_parm *pdrvintcmd_param;
869 struct cmd_priv *pcmdpriv = &padapter->cmdpriv;
871 ph2c = (struct cmd_obj *)_malloc(sizeof(struct cmd_obj));
874 pdrvintcmd_param = (struct drvint_cmd_parm *)_malloc(
875 sizeof(struct drvint_cmd_parm));
876 if (pdrvintcmd_param == NULL) {
877 kfree((unsigned char *)ph2c);
880 pdrvintcmd_param->i_cid = WDG_WK_CID;
881 pdrvintcmd_param->sz = 0;
882 pdrvintcmd_param->pbuf = NULL;
883 init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvintcmd_param, _DRV_INT_CMD_);
884 r8712_enqueue_cmd_ex(pcmdpriv, ph2c);
888 void r8712_survey_cmd_callback(struct _adapter *padapter, struct cmd_obj *pcmd)
890 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
892 if (pcmd->res != H2C_SUCCESS)
893 clr_fwstate(pmlmepriv, _FW_UNDER_SURVEY);
894 r8712_free_cmd_obj(pcmd);
897 void r8712_disassoc_cmd_callback(struct _adapter *padapter,
898 struct cmd_obj *pcmd)
901 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
903 if (pcmd->res != H2C_SUCCESS) {
904 spin_lock_irqsave(&pmlmepriv->lock, irqL);
905 set_fwstate(pmlmepriv, _FW_LINKED);
906 spin_unlock_irqrestore(&pmlmepriv->lock, irqL);
909 r8712_free_cmd_obj(pcmd);
912 void r8712_joinbss_cmd_callback(struct _adapter *padapter, struct cmd_obj *pcmd)
914 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
916 if ((pcmd->res != H2C_SUCCESS))
917 _set_timer(&pmlmepriv->assoc_timer, 1);
918 r8712_free_cmd_obj(pcmd);
921 void r8712_createbss_cmd_callback(struct _adapter *padapter,
922 struct cmd_obj *pcmd)
926 struct sta_info *psta = NULL;
927 struct wlan_network *pwlan = NULL;
928 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
929 struct ndis_wlan_bssid_ex *pnetwork = (struct ndis_wlan_bssid_ex *)
931 struct wlan_network *tgt_network = &(pmlmepriv->cur_network);
933 if ((pcmd->res != H2C_SUCCESS))
934 _set_timer(&pmlmepriv->assoc_timer, 1);
935 _cancel_timer(&pmlmepriv->assoc_timer, &timer_cancelled);
938 pnetwork->Length = le32_to_cpu(pnetwork->Length);
939 pnetwork->Ssid.SsidLength = le32_to_cpu(pnetwork->Ssid.SsidLength);
940 pnetwork->Privacy = le32_to_cpu(pnetwork->Privacy);
941 pnetwork->Rssi = le32_to_cpu(pnetwork->Rssi);
942 pnetwork->NetworkTypeInUse = le32_to_cpu(pnetwork->NetworkTypeInUse);
943 pnetwork->Configuration.ATIMWindow = le32_to_cpu(pnetwork->
944 Configuration.ATIMWindow);
945 pnetwork->Configuration.DSConfig = le32_to_cpu(pnetwork->
946 Configuration.DSConfig);
947 pnetwork->Configuration.FHConfig.DwellTime = le32_to_cpu(pnetwork->
948 Configuration.FHConfig.DwellTime);
949 pnetwork->Configuration.FHConfig.HopPattern = le32_to_cpu(pnetwork->
950 Configuration.FHConfig.HopPattern);
951 pnetwork->Configuration.FHConfig.HopSet = le32_to_cpu(pnetwork->
952 Configuration.FHConfig.HopSet);
953 pnetwork->Configuration.FHConfig.Length = le32_to_cpu(pnetwork->
954 Configuration.FHConfig.Length);
955 pnetwork->Configuration.Length = le32_to_cpu(pnetwork->
956 Configuration.Length);
957 pnetwork->InfrastructureMode = le32_to_cpu(pnetwork->
959 pnetwork->IELength = le32_to_cpu(pnetwork->IELength);
961 spin_lock_irqsave(&pmlmepriv->lock, irqL);
962 if ((pmlmepriv->fw_state) & WIFI_AP_STATE) {
963 psta = r8712_get_stainfo(&padapter->stapriv,
964 pnetwork->MacAddress);
966 psta = r8712_alloc_stainfo(&padapter->stapriv,
967 pnetwork->MacAddress);
969 goto createbss_cmd_fail ;
971 r8712_indicate_connect(padapter);
973 pwlan = _r8712_alloc_network(pmlmepriv);
975 pwlan = r8712_get_oldest_wlan_network(
976 &pmlmepriv->scanned_queue);
978 goto createbss_cmd_fail;
979 pwlan->last_scanned = jiffies;
981 list_insert_tail(&(pwlan->list),
982 &pmlmepriv->scanned_queue.queue);
983 pnetwork->Length = r8712_get_ndis_wlan_bssid_ex_sz(pnetwork);
984 memcpy(&(pwlan->network), pnetwork, pnetwork->Length);
986 memcpy(&tgt_network->network, pnetwork,
987 (r8712_get_ndis_wlan_bssid_ex_sz(pnetwork)));
988 if (pmlmepriv->fw_state & _FW_UNDER_LINKING)
989 pmlmepriv->fw_state ^= _FW_UNDER_LINKING;
990 /* we will set _FW_LINKED when there is one more sat to
991 * join us (stassoc_event_callback) */
994 spin_unlock_irqrestore(&pmlmepriv->lock, irqL);
995 r8712_free_cmd_obj(pcmd);
998 void r8712_setstaKey_cmdrsp_callback(struct _adapter *padapter,
999 struct cmd_obj *pcmd)
1001 struct sta_priv *pstapriv = &padapter->stapriv;
1002 struct set_stakey_rsp *psetstakey_rsp = (struct set_stakey_rsp *)
1004 struct sta_info *psta = r8712_get_stainfo(pstapriv,
1005 psetstakey_rsp->addr);
1009 psta->aid = psta->mac_id = psetstakey_rsp->keyid; /*CAM_ID(CAM_ENTRY)*/
1011 r8712_free_cmd_obj(pcmd);
1014 void r8712_setassocsta_cmdrsp_callback(struct _adapter *padapter,
1015 struct cmd_obj *pcmd)
1018 struct sta_priv *pstapriv = &padapter->stapriv;
1019 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
1020 struct set_assocsta_parm *passocsta_parm =
1021 (struct set_assocsta_parm *)(pcmd->parmbuf);
1022 struct set_assocsta_rsp *passocsta_rsp =
1023 (struct set_assocsta_rsp *) (pcmd->rsp);
1024 struct sta_info *psta = r8712_get_stainfo(pstapriv,
1025 passocsta_parm->addr);
1029 psta->aid = psta->mac_id = passocsta_rsp->cam_id;
1030 spin_lock_irqsave(&pmlmepriv->lock, irqL);
1031 if ((check_fwstate(pmlmepriv, WIFI_MP_STATE)) &&
1032 (check_fwstate(pmlmepriv, _FW_UNDER_LINKING)))
1033 pmlmepriv->fw_state ^= _FW_UNDER_LINKING;
1034 set_fwstate(pmlmepriv, _FW_LINKED);
1035 spin_unlock_irqrestore(&pmlmepriv->lock, irqL);
1036 r8712_free_cmd_obj(pcmd);
1039 u8 r8712_disconnectCtrlEx_cmd(struct _adapter *adapter, u32 enableDrvCtrl,
1040 u32 tryPktCnt, u32 tryPktInterval, u32 firstStageTO)
1042 struct cmd_obj *ph2c;
1043 struct DisconnectCtrlEx_param *param;
1044 struct cmd_priv *pcmdpriv = &adapter->cmdpriv;
1046 ph2c = (struct cmd_obj *)_malloc(sizeof(struct cmd_obj));
1049 param = (struct DisconnectCtrlEx_param *)
1050 _malloc(sizeof(struct DisconnectCtrlEx_param));
1051 if (param == NULL) {
1052 kfree((unsigned char *) ph2c);
1055 memset(param, 0, sizeof(struct DisconnectCtrlEx_param));
1057 param->EnableDrvCtrl = (unsigned char)enableDrvCtrl;
1058 param->TryPktCnt = (unsigned char)tryPktCnt;
1059 param->TryPktInterval = (unsigned char)tryPktInterval;
1060 param->FirstStageTO = (unsigned int)firstStageTO;
1062 init_h2fwcmd_w_parm_no_rsp(ph2c, param,
1063 GEN_CMD_CODE(_DisconnectCtrlEx));
1064 r8712_enqueue_cmd(pcmdpriv, ph2c);