2 * This file contains the handling of command
3 * responses as well as events generated by firmware.
5 #include <linux/delay.h>
6 #include <linux/if_arp.h>
7 #include <linux/netdevice.h>
9 #include <net/iw_handler.h>
19 * @brief This function handles disconnect event. it
20 * reports disconnect to upper layer, clean tx/rx packets,
21 * reset link state etc.
23 * @param priv A pointer to wlan_private structure
26 void libertas_mac_event_disconnected(wlan_private
* priv
)
28 wlan_adapter
*adapter
= priv
->adapter
;
29 union iwreq_data wrqu
;
31 if (adapter
->connect_status
!= LIBERTAS_CONNECTED
)
34 lbs_deb_enter(LBS_DEB_CMD
);
36 memset(wrqu
.ap_addr
.sa_data
, 0x00, ETH_ALEN
);
37 wrqu
.ap_addr
.sa_family
= ARPHRD_ETHER
;
40 * Cisco AP sends EAP failure and de-auth in less than 0.5 ms.
41 * It causes problem in the Supplicant
44 msleep_interruptible(1000);
45 wireless_send_event(priv
->dev
, SIOCGIWAP
, &wrqu
, NULL
);
47 /* Free Tx and Rx packets */
48 kfree_skb(priv
->adapter
->currenttxskb
);
49 priv
->adapter
->currenttxskb
= NULL
;
51 /* report disconnect to upper layer */
52 netif_stop_queue(priv
->dev
);
53 netif_carrier_off(priv
->dev
);
55 /* reset SNR/NF/RSSI values */
56 memset(adapter
->SNR
, 0x00, sizeof(adapter
->SNR
));
57 memset(adapter
->NF
, 0x00, sizeof(adapter
->NF
));
58 memset(adapter
->RSSI
, 0x00, sizeof(adapter
->RSSI
));
59 memset(adapter
->rawSNR
, 0x00, sizeof(adapter
->rawSNR
));
60 memset(adapter
->rawNF
, 0x00, sizeof(adapter
->rawNF
));
61 adapter
->nextSNRNF
= 0;
62 adapter
->numSNRNF
= 0;
63 lbs_deb_cmd("current SSID '%s', length %u\n",
64 escape_essid(adapter
->curbssparams
.ssid
,
65 adapter
->curbssparams
.ssid_len
),
66 adapter
->curbssparams
.ssid_len
);
68 adapter
->connect_status
= LIBERTAS_DISCONNECTED
;
70 /* Clear out associated SSID and BSSID since connection is
73 memset(&adapter
->curbssparams
.bssid
, 0, ETH_ALEN
);
74 memset(&adapter
->curbssparams
.ssid
, 0, IW_ESSID_MAX_SIZE
);
75 adapter
->curbssparams
.ssid_len
= 0;
77 if (adapter
->psstate
!= PS_STATE_FULL_POWER
) {
78 /* make firmware to exit PS mode */
79 lbs_deb_cmd("disconnected, so exit PS mode\n");
80 libertas_ps_wakeup(priv
, 0);
82 lbs_deb_leave(LBS_DEB_CMD
);
86 * @brief This function handles MIC failure event.
88 * @param priv A pointer to wlan_private structure
89 * @para event the event id
92 static void handle_mic_failureevent(wlan_private
* priv
, u32 event
)
96 lbs_deb_enter(LBS_DEB_CMD
);
97 memset(buf
, 0, sizeof(buf
));
99 sprintf(buf
, "%s", "MLME-MICHAELMICFAILURE.indication ");
101 if (event
== MACREG_INT_CODE_MIC_ERR_UNICAST
) {
102 strcat(buf
, "unicast ");
104 strcat(buf
, "multicast ");
107 libertas_send_iwevcustom_event(priv
, buf
);
108 lbs_deb_leave(LBS_DEB_CMD
);
111 static int wlan_ret_reg_access(wlan_private
* priv
,
112 u16 type
, struct cmd_ds_command
*resp
)
115 wlan_adapter
*adapter
= priv
->adapter
;
117 lbs_deb_enter(LBS_DEB_CMD
);
120 case CMD_RET(CMD_MAC_REG_ACCESS
):
122 struct cmd_ds_mac_reg_access
*reg
= &resp
->params
.macreg
;
124 adapter
->offsetvalue
.offset
= (u32
)le16_to_cpu(reg
->offset
);
125 adapter
->offsetvalue
.value
= le32_to_cpu(reg
->value
);
129 case CMD_RET(CMD_BBP_REG_ACCESS
):
131 struct cmd_ds_bbp_reg_access
*reg
= &resp
->params
.bbpreg
;
133 adapter
->offsetvalue
.offset
= (u32
)le16_to_cpu(reg
->offset
);
134 adapter
->offsetvalue
.value
= reg
->value
;
138 case CMD_RET(CMD_RF_REG_ACCESS
):
140 struct cmd_ds_rf_reg_access
*reg
= &resp
->params
.rfreg
;
142 adapter
->offsetvalue
.offset
= (u32
)le16_to_cpu(reg
->offset
);
143 adapter
->offsetvalue
.value
= reg
->value
;
151 lbs_deb_enter_args(LBS_DEB_CMD
, "ret %d", ret
);
155 static int wlan_ret_get_hw_spec(wlan_private
* priv
,
156 struct cmd_ds_command
*resp
)
159 struct cmd_ds_get_hw_spec
*hwspec
= &resp
->params
.hwspec
;
160 wlan_adapter
*adapter
= priv
->adapter
;
163 lbs_deb_enter(LBS_DEB_CMD
);
165 adapter
->fwcapinfo
= le32_to_cpu(hwspec
->fwcapinfo
);
167 memcpy(adapter
->fwreleasenumber
, hwspec
->fwreleasenumber
, 4);
169 lbs_deb_cmd("GET_HW_SPEC: firmware release %u.%u.%up%u\n",
170 adapter
->fwreleasenumber
[2], adapter
->fwreleasenumber
[1],
171 adapter
->fwreleasenumber
[0], adapter
->fwreleasenumber
[3]);
172 lbs_deb_cmd("GET_HW_SPEC: MAC addr " MAC_FMT
"\n",
173 MAC_ARG(hwspec
->permanentaddr
));
174 lbs_deb_cmd("GET_HW_SPEC: hardware interface 0x%x, hardware spec 0x%04x\n",
175 hwspec
->hwifversion
, hwspec
->version
);
177 /* Clamp region code to 8-bit since FW spec indicates that it should
178 * only ever be 8-bit, even though the field size is 16-bit. Some firmware
179 * returns non-zero high 8 bits here.
181 adapter
->regioncode
= le16_to_cpu(hwspec
->regioncode
) & 0xFF;
183 for (i
= 0; i
< MRVDRV_MAX_REGION_CODE
; i
++) {
184 /* use the region code to search for the index */
185 if (adapter
->regioncode
== libertas_region_code_to_index
[i
]) {
190 /* if it's unidentified region code, use the default (USA) */
191 if (i
>= MRVDRV_MAX_REGION_CODE
) {
192 adapter
->regioncode
= 0x10;
193 lbs_pr_info("unidentified region code; using the default (USA)\n");
196 if (adapter
->current_addr
[0] == 0xff)
197 memmove(adapter
->current_addr
, hwspec
->permanentaddr
, ETH_ALEN
);
199 memcpy(priv
->dev
->dev_addr
, adapter
->current_addr
, ETH_ALEN
);
201 memcpy(priv
->mesh_dev
->dev_addr
, adapter
->current_addr
, ETH_ALEN
);
203 if (libertas_set_regiontable(priv
, adapter
->regioncode
, 0)) {
208 if (libertas_set_universaltable(priv
, 0)) {
214 lbs_deb_enter_args(LBS_DEB_CMD
, "ret %d", ret
);
218 static int wlan_ret_802_11_sleep_params(wlan_private
* priv
,
219 struct cmd_ds_command
*resp
)
221 struct cmd_ds_802_11_sleep_params
*sp
= &resp
->params
.sleep_params
;
222 wlan_adapter
*adapter
= priv
->adapter
;
224 lbs_deb_enter(LBS_DEB_CMD
);
226 lbs_deb_cmd("error 0x%x, offset 0x%x, stabletime 0x%x, calcontrol 0x%x "
227 "extsleepclk 0x%x\n", le16_to_cpu(sp
->error
),
228 le16_to_cpu(sp
->offset
), le16_to_cpu(sp
->stabletime
),
229 sp
->calcontrol
, sp
->externalsleepclk
);
231 adapter
->sp
.sp_error
= le16_to_cpu(sp
->error
);
232 adapter
->sp
.sp_offset
= le16_to_cpu(sp
->offset
);
233 adapter
->sp
.sp_stabletime
= le16_to_cpu(sp
->stabletime
);
234 adapter
->sp
.sp_calcontrol
= sp
->calcontrol
;
235 adapter
->sp
.sp_extsleepclk
= sp
->externalsleepclk
;
236 adapter
->sp
.sp_reserved
= le16_to_cpu(sp
->reserved
);
238 lbs_deb_enter(LBS_DEB_CMD
);
242 static int wlan_ret_802_11_stat(wlan_private
* priv
,
243 struct cmd_ds_command
*resp
)
245 lbs_deb_enter(LBS_DEB_CMD
);
246 /* currently adapter->wlan802_11Stat is unused
248 struct cmd_ds_802_11_get_stat *p11Stat = &resp->params.gstat;
249 wlan_adapter *adapter = priv->adapter;
251 // TODO Convert it to Big endian befor copy
252 memcpy(&adapter->wlan802_11Stat,
253 p11Stat, sizeof(struct cmd_ds_802_11_get_stat));
255 lbs_deb_leave(LBS_DEB_CMD
);
259 static int wlan_ret_802_11_snmp_mib(wlan_private
* priv
,
260 struct cmd_ds_command
*resp
)
262 struct cmd_ds_802_11_snmp_mib
*smib
= &resp
->params
.smib
;
263 u16 oid
= le16_to_cpu(smib
->oid
);
264 u16 querytype
= le16_to_cpu(smib
->querytype
);
266 lbs_deb_enter(LBS_DEB_CMD
);
268 lbs_deb_cmd("SNMP_RESP: oid 0x%x, querytype 0x%x\n", oid
,
270 lbs_deb_cmd("SNMP_RESP: Buf size %d\n", le16_to_cpu(smib
->bufsize
));
272 if (querytype
== CMD_ACT_GET
) {
275 priv
->adapter
->fragthsd
=
276 le16_to_cpu(*((__le16
*)(smib
->value
)));
277 lbs_deb_cmd("SNMP_RESP: frag threshold %u\n",
278 priv
->adapter
->fragthsd
);
281 priv
->adapter
->rtsthsd
=
282 le16_to_cpu(*((__le16
*)(smib
->value
)));
283 lbs_deb_cmd("SNMP_RESP: rts threshold %u\n",
284 priv
->adapter
->rtsthsd
);
286 case SHORT_RETRYLIM_I
:
287 priv
->adapter
->txretrycount
=
288 le16_to_cpu(*((__le16
*)(smib
->value
)));
289 lbs_deb_cmd("SNMP_RESP: tx retry count %u\n",
290 priv
->adapter
->rtsthsd
);
297 lbs_deb_enter(LBS_DEB_CMD
);
301 static int wlan_ret_802_11_key_material(wlan_private
* priv
,
302 struct cmd_ds_command
*resp
)
304 struct cmd_ds_802_11_key_material
*pkeymaterial
=
305 &resp
->params
.keymaterial
;
306 wlan_adapter
*adapter
= priv
->adapter
;
307 u16 action
= le16_to_cpu(pkeymaterial
->action
);
309 lbs_deb_enter(LBS_DEB_CMD
);
311 /* Copy the returned key to driver private data */
312 if (action
== CMD_ACT_GET
) {
313 u8
* buf_ptr
= (u8
*) &pkeymaterial
->keyParamSet
;
314 u8
* resp_end
= (u8
*) (resp
+ le16_to_cpu(resp
->size
));
316 while (buf_ptr
< resp_end
) {
317 struct MrvlIEtype_keyParamSet
* pkeyparamset
=
318 (struct MrvlIEtype_keyParamSet
*) buf_ptr
;
319 struct enc_key
* pkey
;
320 u16 param_set_len
= le16_to_cpu(pkeyparamset
->length
);
321 u16 key_len
= le16_to_cpu(pkeyparamset
->keylen
);
322 u16 key_flags
= le16_to_cpu(pkeyparamset
->keyinfo
);
323 u16 key_type
= le16_to_cpu(pkeyparamset
->keytypeid
);
326 end
= (u8
*) pkeyparamset
+ sizeof (pkeyparamset
->type
)
327 + sizeof (pkeyparamset
->length
)
329 /* Make sure we don't access past the end of the IEs */
333 if (key_flags
& KEY_INFO_WPA_UNICAST
)
334 pkey
= &adapter
->wpa_unicast_key
;
335 else if (key_flags
& KEY_INFO_WPA_MCAST
)
336 pkey
= &adapter
->wpa_mcast_key
;
340 /* Copy returned key into driver */
341 memset(pkey
, 0, sizeof(struct enc_key
));
342 if (key_len
> sizeof(pkey
->key
))
344 pkey
->type
= key_type
;
345 pkey
->flags
= key_flags
;
347 memcpy(pkey
->key
, pkeyparamset
->key
, pkey
->len
);
353 lbs_deb_enter(LBS_DEB_CMD
);
357 static int wlan_ret_802_11_mac_address(wlan_private
* priv
,
358 struct cmd_ds_command
*resp
)
360 struct cmd_ds_802_11_mac_address
*macadd
= &resp
->params
.macadd
;
361 wlan_adapter
*adapter
= priv
->adapter
;
363 lbs_deb_enter(LBS_DEB_CMD
);
365 memcpy(adapter
->current_addr
, macadd
->macadd
, ETH_ALEN
);
367 lbs_deb_enter(LBS_DEB_CMD
);
371 static int wlan_ret_802_11_rf_tx_power(wlan_private
* priv
,
372 struct cmd_ds_command
*resp
)
374 struct cmd_ds_802_11_rf_tx_power
*rtp
= &resp
->params
.txp
;
375 wlan_adapter
*adapter
= priv
->adapter
;
377 lbs_deb_enter(LBS_DEB_CMD
);
379 adapter
->txpowerlevel
= le16_to_cpu(rtp
->currentlevel
);
381 lbs_deb_cmd("TX power currently %d\n", adapter
->txpowerlevel
);
383 lbs_deb_leave(LBS_DEB_CMD
);
387 static int wlan_ret_802_11_rate_adapt_rateset(wlan_private
* priv
,
388 struct cmd_ds_command
*resp
)
390 struct cmd_ds_802_11_rate_adapt_rateset
*rates
= &resp
->params
.rateset
;
391 wlan_adapter
*adapter
= priv
->adapter
;
393 lbs_deb_enter(LBS_DEB_CMD
);
395 if (rates
->action
== CMD_ACT_GET
) {
396 adapter
->enablehwauto
= le16_to_cpu(rates
->enablehwauto
);
397 adapter
->ratebitmap
= le16_to_cpu(rates
->bitmap
);
400 lbs_deb_leave(LBS_DEB_CMD
);
404 static int wlan_ret_802_11_data_rate(wlan_private
* priv
,
405 struct cmd_ds_command
*resp
)
407 struct cmd_ds_802_11_data_rate
*pdatarate
= &resp
->params
.drate
;
408 wlan_adapter
*adapter
= priv
->adapter
;
410 lbs_deb_enter(LBS_DEB_CMD
);
412 lbs_deb_hex(LBS_DEB_CMD
, "DATA_RATE_RESP", (u8
*) pdatarate
,
413 sizeof(struct cmd_ds_802_11_data_rate
));
415 /* FIXME: get actual rates FW can do if this command actually returns
416 * all data rates supported.
418 adapter
->cur_rate
= libertas_fw_index_to_data_rate(pdatarate
->rates
[0]);
419 lbs_deb_cmd("DATA_RATE: current rate 0x%02x\n", adapter
->cur_rate
);
421 lbs_deb_leave(LBS_DEB_CMD
);
425 static int wlan_ret_802_11_rf_channel(wlan_private
* priv
,
426 struct cmd_ds_command
*resp
)
428 struct cmd_ds_802_11_rf_channel
*rfchannel
= &resp
->params
.rfchannel
;
429 wlan_adapter
*adapter
= priv
->adapter
;
430 u16 action
= le16_to_cpu(rfchannel
->action
);
431 u16 newchannel
= le16_to_cpu(rfchannel
->currentchannel
);
433 lbs_deb_enter(LBS_DEB_CMD
);
435 if (action
== CMD_OPT_802_11_RF_CHANNEL_GET
436 && adapter
->curbssparams
.channel
!= newchannel
) {
437 lbs_deb_cmd("channel switch from %d to %d\n",
438 adapter
->curbssparams
.channel
, newchannel
);
440 /* Update the channel again */
441 adapter
->curbssparams
.channel
= newchannel
;
444 lbs_deb_enter(LBS_DEB_CMD
);
448 static int wlan_ret_802_11_rssi(wlan_private
* priv
,
449 struct cmd_ds_command
*resp
)
451 struct cmd_ds_802_11_rssi_rsp
*rssirsp
= &resp
->params
.rssirsp
;
452 wlan_adapter
*adapter
= priv
->adapter
;
454 lbs_deb_enter(LBS_DEB_CMD
);
456 /* store the non average value */
457 adapter
->SNR
[TYPE_BEACON
][TYPE_NOAVG
] = le16_to_cpu(rssirsp
->SNR
);
458 adapter
->NF
[TYPE_BEACON
][TYPE_NOAVG
] = le16_to_cpu(rssirsp
->noisefloor
);
460 adapter
->SNR
[TYPE_BEACON
][TYPE_AVG
] = le16_to_cpu(rssirsp
->avgSNR
);
461 adapter
->NF
[TYPE_BEACON
][TYPE_AVG
] = le16_to_cpu(rssirsp
->avgnoisefloor
);
463 adapter
->RSSI
[TYPE_BEACON
][TYPE_NOAVG
] =
464 CAL_RSSI(adapter
->SNR
[TYPE_BEACON
][TYPE_NOAVG
],
465 adapter
->NF
[TYPE_BEACON
][TYPE_NOAVG
]);
467 adapter
->RSSI
[TYPE_BEACON
][TYPE_AVG
] =
468 CAL_RSSI(adapter
->SNR
[TYPE_BEACON
][TYPE_AVG
] / AVG_SCALE
,
469 adapter
->NF
[TYPE_BEACON
][TYPE_AVG
] / AVG_SCALE
);
471 lbs_deb_cmd("RSSI: beacon %d, avg %d\n",
472 adapter
->RSSI
[TYPE_BEACON
][TYPE_NOAVG
],
473 adapter
->RSSI
[TYPE_BEACON
][TYPE_AVG
]);
475 lbs_deb_leave(LBS_DEB_CMD
);
479 static int wlan_ret_802_11_eeprom_access(wlan_private
* priv
,
480 struct cmd_ds_command
*resp
)
482 wlan_adapter
*adapter
= priv
->adapter
;
483 struct wlan_ioctl_regrdwr
*pbuf
;
484 pbuf
= (struct wlan_ioctl_regrdwr
*) adapter
->prdeeprom
;
486 lbs_deb_enter_args(LBS_DEB_CMD
, "len %d",
487 le16_to_cpu(resp
->params
.rdeeprom
.bytecount
));
488 if (pbuf
->NOB
< le16_to_cpu(resp
->params
.rdeeprom
.bytecount
)) {
490 lbs_deb_cmd("EEPROM read length too big\n");
493 pbuf
->NOB
= le16_to_cpu(resp
->params
.rdeeprom
.bytecount
);
496 memcpy(&pbuf
->value
, (u8
*) & resp
->params
.rdeeprom
.value
,
497 le16_to_cpu(resp
->params
.rdeeprom
.bytecount
));
498 lbs_deb_hex(LBS_DEB_CMD
, "EEPROM", (char *)&pbuf
->value
,
499 le16_to_cpu(resp
->params
.rdeeprom
.bytecount
));
501 lbs_deb_leave(LBS_DEB_CMD
);
505 static int wlan_ret_get_log(wlan_private
* priv
,
506 struct cmd_ds_command
*resp
)
508 struct cmd_ds_802_11_get_log
*logmessage
= &resp
->params
.glog
;
509 wlan_adapter
*adapter
= priv
->adapter
;
511 lbs_deb_enter(LBS_DEB_CMD
);
513 /* Stored little-endian */
514 memcpy(&adapter
->logmsg
, logmessage
, sizeof(struct cmd_ds_802_11_get_log
));
516 lbs_deb_leave(LBS_DEB_CMD
);
520 static int libertas_ret_802_11_enable_rsn(wlan_private
* priv
,
521 struct cmd_ds_command
*resp
)
523 struct cmd_ds_802_11_enable_rsn
*enable_rsn
= &resp
->params
.enbrsn
;
524 wlan_adapter
*adapter
= priv
->adapter
;
525 u32
* pdata_buf
= adapter
->cur_cmd
->pdata_buf
;
527 lbs_deb_enter(LBS_DEB_CMD
);
529 if (enable_rsn
->action
== cpu_to_le16(CMD_ACT_GET
)) {
531 *pdata_buf
= (u32
) le16_to_cpu(enable_rsn
->enable
);
534 lbs_deb_leave(LBS_DEB_CMD
);
538 static inline int handle_cmd_response(u16 respcmd
,
539 struct cmd_ds_command
*resp
,
544 wlan_adapter
*adapter
= priv
->adapter
;
546 lbs_deb_enter(LBS_DEB_HOST
);
549 case CMD_RET(CMD_MAC_REG_ACCESS
):
550 case CMD_RET(CMD_BBP_REG_ACCESS
):
551 case CMD_RET(CMD_RF_REG_ACCESS
):
552 ret
= wlan_ret_reg_access(priv
, respcmd
, resp
);
555 case CMD_RET(CMD_GET_HW_SPEC
):
556 ret
= wlan_ret_get_hw_spec(priv
, resp
);
559 case CMD_RET(CMD_802_11_SCAN
):
560 ret
= libertas_ret_80211_scan(priv
, resp
);
563 case CMD_RET(CMD_802_11_GET_LOG
):
564 ret
= wlan_ret_get_log(priv
, resp
);
567 case CMD_RET_802_11_ASSOCIATE
:
568 case CMD_RET(CMD_802_11_ASSOCIATE
):
569 case CMD_RET(CMD_802_11_REASSOCIATE
):
570 ret
= libertas_ret_80211_associate(priv
, resp
);
573 case CMD_RET(CMD_802_11_DISASSOCIATE
):
574 case CMD_RET(CMD_802_11_DEAUTHENTICATE
):
575 ret
= libertas_ret_80211_disassociate(priv
, resp
);
578 case CMD_RET(CMD_802_11_AD_HOC_START
):
579 case CMD_RET(CMD_802_11_AD_HOC_JOIN
):
580 ret
= libertas_ret_80211_ad_hoc_start(priv
, resp
);
583 case CMD_RET(CMD_802_11_GET_STAT
):
584 ret
= wlan_ret_802_11_stat(priv
, resp
);
587 case CMD_RET(CMD_802_11_SNMP_MIB
):
588 ret
= wlan_ret_802_11_snmp_mib(priv
, resp
);
591 case CMD_RET(CMD_802_11_RF_TX_POWER
):
592 ret
= wlan_ret_802_11_rf_tx_power(priv
, resp
);
595 case CMD_RET(CMD_802_11_SET_AFC
):
596 case CMD_RET(CMD_802_11_GET_AFC
):
597 spin_lock_irqsave(&adapter
->driver_lock
, flags
);
598 memmove(adapter
->cur_cmd
->pdata_buf
, &resp
->params
.afc
,
599 sizeof(struct cmd_ds_802_11_afc
));
600 spin_unlock_irqrestore(&adapter
->driver_lock
, flags
);
604 case CMD_RET(CMD_MAC_MULTICAST_ADR
):
605 case CMD_RET(CMD_MAC_CONTROL
):
606 case CMD_RET(CMD_802_11_SET_WEP
):
607 case CMD_RET(CMD_802_11_RESET
):
608 case CMD_RET(CMD_802_11_AUTHENTICATE
):
609 case CMD_RET(CMD_802_11_RADIO_CONTROL
):
610 case CMD_RET(CMD_802_11_BEACON_STOP
):
613 case CMD_RET(CMD_802_11_ENABLE_RSN
):
614 ret
= libertas_ret_802_11_enable_rsn(priv
, resp
);
617 case CMD_RET(CMD_802_11_DATA_RATE
):
618 ret
= wlan_ret_802_11_data_rate(priv
, resp
);
620 case CMD_RET(CMD_802_11_RATE_ADAPT_RATESET
):
621 ret
= wlan_ret_802_11_rate_adapt_rateset(priv
, resp
);
623 case CMD_RET(CMD_802_11_RF_CHANNEL
):
624 ret
= wlan_ret_802_11_rf_channel(priv
, resp
);
627 case CMD_RET(CMD_802_11_RSSI
):
628 ret
= wlan_ret_802_11_rssi(priv
, resp
);
631 case CMD_RET(CMD_802_11_MAC_ADDRESS
):
632 ret
= wlan_ret_802_11_mac_address(priv
, resp
);
635 case CMD_RET(CMD_802_11_AD_HOC_STOP
):
636 ret
= libertas_ret_80211_ad_hoc_stop(priv
, resp
);
639 case CMD_RET(CMD_802_11_KEY_MATERIAL
):
640 ret
= wlan_ret_802_11_key_material(priv
, resp
);
643 case CMD_RET(CMD_802_11_EEPROM_ACCESS
):
644 ret
= wlan_ret_802_11_eeprom_access(priv
, resp
);
647 case CMD_RET(CMD_802_11D_DOMAIN_INFO
):
648 ret
= libertas_ret_802_11d_domain_info(priv
, resp
);
651 case CMD_RET(CMD_802_11_SLEEP_PARAMS
):
652 ret
= wlan_ret_802_11_sleep_params(priv
, resp
);
654 case CMD_RET(CMD_802_11_INACTIVITY_TIMEOUT
):
655 spin_lock_irqsave(&adapter
->driver_lock
, flags
);
656 *((u16
*) adapter
->cur_cmd
->pdata_buf
) =
657 le16_to_cpu(resp
->params
.inactivity_timeout
.timeout
);
658 spin_unlock_irqrestore(&adapter
->driver_lock
, flags
);
661 case CMD_RET(CMD_802_11_TPC_CFG
):
662 spin_lock_irqsave(&adapter
->driver_lock
, flags
);
663 memmove(adapter
->cur_cmd
->pdata_buf
, &resp
->params
.tpccfg
,
664 sizeof(struct cmd_ds_802_11_tpc_cfg
));
665 spin_unlock_irqrestore(&adapter
->driver_lock
, flags
);
667 case CMD_RET(CMD_802_11_LED_GPIO_CTRL
):
668 spin_lock_irqsave(&adapter
->driver_lock
, flags
);
669 memmove(adapter
->cur_cmd
->pdata_buf
, &resp
->params
.ledgpio
,
670 sizeof(struct cmd_ds_802_11_led_ctrl
));
671 spin_unlock_irqrestore(&adapter
->driver_lock
, flags
);
673 case CMD_RET(CMD_802_11_PWR_CFG
):
674 spin_lock_irqsave(&adapter
->driver_lock
, flags
);
675 memmove(adapter
->cur_cmd
->pdata_buf
, &resp
->params
.pwrcfg
,
676 sizeof(struct cmd_ds_802_11_pwr_cfg
));
677 spin_unlock_irqrestore(&adapter
->driver_lock
, flags
);
681 case CMD_RET(CMD_GET_TSF
):
682 spin_lock_irqsave(&adapter
->driver_lock
, flags
);
683 memcpy(priv
->adapter
->cur_cmd
->pdata_buf
,
684 &resp
->params
.gettsf
.tsfvalue
, sizeof(u64
));
685 spin_unlock_irqrestore(&adapter
->driver_lock
, flags
);
687 case CMD_RET(CMD_BT_ACCESS
):
688 spin_lock_irqsave(&adapter
->driver_lock
, flags
);
689 if (adapter
->cur_cmd
->pdata_buf
)
690 memcpy(adapter
->cur_cmd
->pdata_buf
,
691 &resp
->params
.bt
.addr1
, 2 * ETH_ALEN
);
692 spin_unlock_irqrestore(&adapter
->driver_lock
, flags
);
694 case CMD_RET(CMD_FWT_ACCESS
):
695 spin_lock_irqsave(&adapter
->driver_lock
, flags
);
696 if (adapter
->cur_cmd
->pdata_buf
)
697 memcpy(adapter
->cur_cmd
->pdata_buf
, &resp
->params
.fwt
,
698 sizeof(resp
->params
.fwt
));
699 spin_unlock_irqrestore(&adapter
->driver_lock
, flags
);
701 case CMD_RET(CMD_MESH_ACCESS
):
702 if (adapter
->cur_cmd
->pdata_buf
)
703 memcpy(adapter
->cur_cmd
->pdata_buf
, &resp
->params
.mesh
,
704 sizeof(resp
->params
.mesh
));
707 lbs_deb_host("CMD_RESP: unknown cmd response 0x%04x\n",
711 lbs_deb_leave(LBS_DEB_HOST
);
715 int libertas_process_rx_command(wlan_private
* priv
)
718 struct cmd_ds_command
*resp
;
719 wlan_adapter
*adapter
= priv
->adapter
;
724 lbs_deb_enter(LBS_DEB_HOST
);
726 /* Now we got response from FW, cancel the command timer */
727 del_timer(&adapter
->command_timer
);
729 mutex_lock(&adapter
->lock
);
730 spin_lock_irqsave(&adapter
->driver_lock
, flags
);
732 if (!adapter
->cur_cmd
) {
733 lbs_deb_host("CMD_RESP: cur_cmd is NULL\n");
735 spin_unlock_irqrestore(&adapter
->driver_lock
, flags
);
738 resp
= (struct cmd_ds_command
*)(adapter
->cur_cmd
->bufvirtualaddr
);
740 respcmd
= le16_to_cpu(resp
->command
);
741 result
= le16_to_cpu(resp
->result
);
743 lbs_deb_host("CMD_RESP: response 0x%04x, size %d, jiffies %lu\n",
744 respcmd
, priv
->upld_len
, jiffies
);
745 lbs_deb_hex(LBS_DEB_HOST
, "CMD_RESP", adapter
->cur_cmd
->bufvirtualaddr
,
748 if (!(respcmd
& 0x8000)) {
749 lbs_deb_host("invalid response!\n");
750 adapter
->cur_cmd_retcode
= -1;
751 __libertas_cleanup_and_insert_cmd(priv
, adapter
->cur_cmd
);
752 adapter
->nr_cmd_pending
--;
753 adapter
->cur_cmd
= NULL
;
754 spin_unlock_irqrestore(&adapter
->driver_lock
, flags
);
759 /* Store the response code to cur_cmd_retcode. */
760 adapter
->cur_cmd_retcode
= result
;;
762 if (respcmd
== CMD_RET(CMD_802_11_PS_MODE
)) {
763 struct cmd_ds_802_11_ps_mode
*psmode
= &resp
->params
.psmode
;
764 u16 action
= le16_to_cpu(psmode
->action
);
767 "CMD_RESP: PS_MODE cmd reply result 0x%x, action 0x%x\n",
771 lbs_deb_host("CMD_RESP: PS command failed with 0x%x\n",
774 * We should not re-try enter-ps command in
775 * ad-hoc mode. It takes place in
776 * libertas_execute_next_command().
778 if (adapter
->mode
== IW_MODE_ADHOC
&&
779 action
== CMD_SUBCMD_ENTER_PS
)
780 adapter
->psmode
= WLAN802_11POWERMODECAM
;
781 } else if (action
== CMD_SUBCMD_ENTER_PS
) {
782 adapter
->needtowakeup
= 0;
783 adapter
->psstate
= PS_STATE_AWAKE
;
785 lbs_deb_host("CMD_RESP: ENTER_PS command response\n");
786 if (adapter
->connect_status
!= LIBERTAS_CONNECTED
) {
788 * When Deauth Event received before Enter_PS command
789 * response, We need to wake up the firmware.
792 "disconnected, invoking libertas_ps_wakeup\n");
794 spin_unlock_irqrestore(&adapter
->driver_lock
, flags
);
795 mutex_unlock(&adapter
->lock
);
796 libertas_ps_wakeup(priv
, 0);
797 mutex_lock(&adapter
->lock
);
798 spin_lock_irqsave(&adapter
->driver_lock
, flags
);
800 } else if (action
== CMD_SUBCMD_EXIT_PS
) {
801 adapter
->needtowakeup
= 0;
802 adapter
->psstate
= PS_STATE_FULL_POWER
;
803 lbs_deb_host("CMD_RESP: EXIT_PS command response\n");
805 lbs_deb_host("CMD_RESP: PS action 0x%X\n", action
);
808 __libertas_cleanup_and_insert_cmd(priv
, adapter
->cur_cmd
);
809 adapter
->nr_cmd_pending
--;
810 adapter
->cur_cmd
= NULL
;
811 spin_unlock_irqrestore(&adapter
->driver_lock
, flags
);
817 if (adapter
->cur_cmd
->cmdflags
& CMD_F_HOSTCMD
) {
818 /* Copy the response back to response buffer */
819 memcpy(adapter
->cur_cmd
->pdata_buf
, resp
,
820 le16_to_cpu(resp
->size
));
821 adapter
->cur_cmd
->cmdflags
&= ~CMD_F_HOSTCMD
;
824 /* If the command is not successful, cleanup and return failure */
825 if ((result
!= 0 || !(respcmd
& 0x8000))) {
826 lbs_deb_host("CMD_RESP: error 0x%04x in command reply 0x%04x\n",
829 * Handling errors here
832 case CMD_RET(CMD_GET_HW_SPEC
):
833 case CMD_RET(CMD_802_11_RESET
):
834 lbs_deb_host("CMD_RESP: reset failed\n");
839 __libertas_cleanup_and_insert_cmd(priv
, adapter
->cur_cmd
);
840 adapter
->nr_cmd_pending
--;
841 adapter
->cur_cmd
= NULL
;
842 spin_unlock_irqrestore(&adapter
->driver_lock
, flags
);
848 spin_unlock_irqrestore(&adapter
->driver_lock
, flags
);
850 ret
= handle_cmd_response(respcmd
, resp
, priv
);
852 spin_lock_irqsave(&adapter
->driver_lock
, flags
);
853 if (adapter
->cur_cmd
) {
854 /* Clean up and Put current command back to cmdfreeq */
855 __libertas_cleanup_and_insert_cmd(priv
, adapter
->cur_cmd
);
856 adapter
->nr_cmd_pending
--;
857 WARN_ON(adapter
->nr_cmd_pending
> 128);
858 adapter
->cur_cmd
= NULL
;
860 spin_unlock_irqrestore(&adapter
->driver_lock
, flags
);
863 mutex_unlock(&adapter
->lock
);
864 lbs_deb_leave_args(LBS_DEB_HOST
, "ret %d", ret
);
868 int libertas_process_event(wlan_private
* priv
)
871 wlan_adapter
*adapter
= priv
->adapter
;
874 lbs_deb_enter(LBS_DEB_CMD
);
876 spin_lock_irq(&adapter
->driver_lock
);
877 eventcause
= adapter
->eventcause
;
878 spin_unlock_irq(&adapter
->driver_lock
);
880 lbs_deb_cmd("event cause 0x%x\n", eventcause
);
882 switch (eventcause
>> SBI_EVENT_CAUSE_SHIFT
) {
883 case MACREG_INT_CODE_LINK_SENSED
:
884 lbs_deb_cmd("EVENT: MACREG_INT_CODE_LINK_SENSED\n");
887 case MACREG_INT_CODE_DEAUTHENTICATED
:
888 lbs_deb_cmd("EVENT: deauthenticated\n");
889 libertas_mac_event_disconnected(priv
);
892 case MACREG_INT_CODE_DISASSOCIATED
:
893 lbs_deb_cmd("EVENT: disassociated\n");
894 libertas_mac_event_disconnected(priv
);
897 case MACREG_INT_CODE_LINK_LOSE_NO_SCAN
:
898 lbs_deb_cmd("EVENT: link lost\n");
899 libertas_mac_event_disconnected(priv
);
902 case MACREG_INT_CODE_PS_SLEEP
:
903 lbs_deb_cmd("EVENT: sleep\n");
905 /* handle unexpected PS SLEEP event */
906 if (adapter
->psstate
== PS_STATE_FULL_POWER
) {
908 "EVENT: in FULL POWER mode, ignoreing PS_SLEEP\n");
911 adapter
->psstate
= PS_STATE_PRE_SLEEP
;
913 libertas_ps_confirm_sleep(priv
, (u16
) adapter
->psmode
);
917 case MACREG_INT_CODE_PS_AWAKE
:
918 lbs_deb_cmd("EVENT: awake\n");
920 /* handle unexpected PS AWAKE event */
921 if (adapter
->psstate
== PS_STATE_FULL_POWER
) {
923 "EVENT: In FULL POWER mode - ignore PS AWAKE\n");
927 adapter
->psstate
= PS_STATE_AWAKE
;
929 if (adapter
->needtowakeup
) {
931 * wait for the command processing to finish
932 * before resuming sending
933 * adapter->needtowakeup will be set to FALSE
934 * in libertas_ps_wakeup()
936 lbs_deb_cmd("waking up ...\n");
937 libertas_ps_wakeup(priv
, 0);
941 case MACREG_INT_CODE_MIC_ERR_UNICAST
:
942 lbs_deb_cmd("EVENT: UNICAST MIC ERROR\n");
943 handle_mic_failureevent(priv
, MACREG_INT_CODE_MIC_ERR_UNICAST
);
946 case MACREG_INT_CODE_MIC_ERR_MULTICAST
:
947 lbs_deb_cmd("EVENT: MULTICAST MIC ERROR\n");
948 handle_mic_failureevent(priv
, MACREG_INT_CODE_MIC_ERR_MULTICAST
);
950 case MACREG_INT_CODE_MIB_CHANGED
:
951 case MACREG_INT_CODE_INIT_DONE
:
954 case MACREG_INT_CODE_ADHOC_BCN_LOST
:
955 lbs_deb_cmd("EVENT: ADHOC beacon lost\n");
958 case MACREG_INT_CODE_RSSI_LOW
:
959 lbs_pr_alert("EVENT: rssi low\n");
961 case MACREG_INT_CODE_SNR_LOW
:
962 lbs_pr_alert("EVENT: snr low\n");
964 case MACREG_INT_CODE_MAX_FAIL
:
965 lbs_pr_alert("EVENT: max fail\n");
967 case MACREG_INT_CODE_RSSI_HIGH
:
968 lbs_pr_alert("EVENT: rssi high\n");
970 case MACREG_INT_CODE_SNR_HIGH
:
971 lbs_pr_alert("EVENT: snr high\n");
974 case MACREG_INT_CODE_MESH_AUTO_STARTED
:
975 /* Ignore spurious autostart events if autostart is disabled */
976 if (!priv
->mesh_autostart_enabled
) {
977 lbs_pr_info("EVENT: MESH_AUTO_STARTED (ignoring)\n");
980 lbs_pr_info("EVENT: MESH_AUTO_STARTED\n");
981 adapter
->connect_status
= LIBERTAS_CONNECTED
;
982 if (priv
->mesh_open
== 1) {
983 netif_wake_queue(priv
->mesh_dev
);
984 netif_carrier_on(priv
->mesh_dev
);
986 adapter
->mode
= IW_MODE_ADHOC
;
987 schedule_work(&priv
->sync_channel
);
991 lbs_pr_alert("EVENT: unknown event id 0x%04x\n",
992 eventcause
>> SBI_EVENT_CAUSE_SHIFT
);
996 spin_lock_irq(&adapter
->driver_lock
);
997 adapter
->eventcause
= 0;
998 spin_unlock_irq(&adapter
->driver_lock
);
1000 lbs_deb_leave_args(LBS_DEB_CMD
, "ret %d", ret
);