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 adapter->regioncode = le16_to_cpu(hwspec->regioncode);
179 for (i = 0; i < MRVDRV_MAX_REGION_CODE; i++) {
180 /* use the region code to search for the index */
181 if (adapter->regioncode == libertas_region_code_to_index[i]) {
186 /* if it's unidentified region code, use the default (USA) */
187 if (i >= MRVDRV_MAX_REGION_CODE) {
188 adapter->regioncode = 0x10;
189 lbs_pr_info("unidentified region code; using the default (USA)\n");
192 if (adapter->current_addr[0] == 0xff)
193 memmove(adapter->current_addr, hwspec->permanentaddr, ETH_ALEN);
195 memcpy(priv->dev->dev_addr, adapter->current_addr, ETH_ALEN);
197 memcpy(priv->mesh_dev->dev_addr, adapter->current_addr, ETH_ALEN);
199 if (libertas_set_regiontable(priv, adapter->regioncode, 0)) {
204 if (libertas_set_universaltable(priv, 0)) {
210 lbs_deb_enter_args(LBS_DEB_CMD, "ret %d", ret);
214 static int wlan_ret_802_11_sleep_params(wlan_private * priv,
215 struct cmd_ds_command *resp)
217 struct cmd_ds_802_11_sleep_params *sp = &resp->params.sleep_params;
218 wlan_adapter *adapter = priv->adapter;
220 lbs_deb_enter(LBS_DEB_CMD);
222 lbs_deb_cmd("error 0x%x, offset 0x%x, stabletime 0x%x, calcontrol 0x%x "
223 "extsleepclk 0x%x\n", le16_to_cpu(sp->error),
224 le16_to_cpu(sp->offset), le16_to_cpu(sp->stabletime),
225 sp->calcontrol, sp->externalsleepclk);
227 adapter->sp.sp_error = le16_to_cpu(sp->error);
228 adapter->sp.sp_offset = le16_to_cpu(sp->offset);
229 adapter->sp.sp_stabletime = le16_to_cpu(sp->stabletime);
230 adapter->sp.sp_calcontrol = sp->calcontrol;
231 adapter->sp.sp_extsleepclk = sp->externalsleepclk;
232 adapter->sp.sp_reserved = le16_to_cpu(sp->reserved);
234 lbs_deb_enter(LBS_DEB_CMD);
238 static int wlan_ret_802_11_stat(wlan_private * priv,
239 struct cmd_ds_command *resp)
241 lbs_deb_enter(LBS_DEB_CMD);
242 /* currently adapter->wlan802_11Stat is unused
244 struct cmd_ds_802_11_get_stat *p11Stat = &resp->params.gstat;
245 wlan_adapter *adapter = priv->adapter;
247 // TODO Convert it to Big endian befor copy
248 memcpy(&adapter->wlan802_11Stat,
249 p11Stat, sizeof(struct cmd_ds_802_11_get_stat));
251 lbs_deb_leave(LBS_DEB_CMD);
255 static int wlan_ret_802_11_snmp_mib(wlan_private * priv,
256 struct cmd_ds_command *resp)
258 struct cmd_ds_802_11_snmp_mib *smib = &resp->params.smib;
259 u16 oid = le16_to_cpu(smib->oid);
260 u16 querytype = le16_to_cpu(smib->querytype);
262 lbs_deb_enter(LBS_DEB_CMD);
264 lbs_deb_cmd("SNMP_RESP: oid 0x%x, querytype 0x%x\n", oid,
266 lbs_deb_cmd("SNMP_RESP: Buf size %d\n", le16_to_cpu(smib->bufsize));
268 if (querytype == CMD_ACT_GET) {
271 priv->adapter->fragthsd =
272 le16_to_cpu(*((__le16 *)(smib->value)));
273 lbs_deb_cmd("SNMP_RESP: frag threshold %u\n",
274 priv->adapter->fragthsd);
277 priv->adapter->rtsthsd =
278 le16_to_cpu(*((__le16 *)(smib->value)));
279 lbs_deb_cmd("SNMP_RESP: rts threshold %u\n",
280 priv->adapter->rtsthsd);
282 case SHORT_RETRYLIM_I:
283 priv->adapter->txretrycount =
284 le16_to_cpu(*((__le16 *)(smib->value)));
285 lbs_deb_cmd("SNMP_RESP: tx retry count %u\n",
286 priv->adapter->rtsthsd);
293 lbs_deb_enter(LBS_DEB_CMD);
297 static int wlan_ret_802_11_key_material(wlan_private * priv,
298 struct cmd_ds_command *resp)
300 struct cmd_ds_802_11_key_material *pkeymaterial =
301 &resp->params.keymaterial;
302 wlan_adapter *adapter = priv->adapter;
303 u16 action = le16_to_cpu(pkeymaterial->action);
305 lbs_deb_enter(LBS_DEB_CMD);
307 /* Copy the returned key to driver private data */
308 if (action == CMD_ACT_GET) {
309 u8 * buf_ptr = (u8 *) &pkeymaterial->keyParamSet;
310 u8 * resp_end = (u8 *) (resp + le16_to_cpu(resp->size));
312 while (buf_ptr < resp_end) {
313 struct MrvlIEtype_keyParamSet * pkeyparamset =
314 (struct MrvlIEtype_keyParamSet *) buf_ptr;
315 struct enc_key * pkey;
316 u16 param_set_len = le16_to_cpu(pkeyparamset->length);
317 u16 key_len = le16_to_cpu(pkeyparamset->keylen);
318 u16 key_flags = le16_to_cpu(pkeyparamset->keyinfo);
319 u16 key_type = le16_to_cpu(pkeyparamset->keytypeid);
322 end = (u8 *) pkeyparamset + sizeof (pkeyparamset->type)
323 + sizeof (pkeyparamset->length)
325 /* Make sure we don't access past the end of the IEs */
329 if (key_flags & KEY_INFO_WPA_UNICAST)
330 pkey = &adapter->wpa_unicast_key;
331 else if (key_flags & KEY_INFO_WPA_MCAST)
332 pkey = &adapter->wpa_mcast_key;
336 /* Copy returned key into driver */
337 memset(pkey, 0, sizeof(struct enc_key));
338 if (key_len > sizeof(pkey->key))
340 pkey->type = key_type;
341 pkey->flags = key_flags;
343 memcpy(pkey->key, pkeyparamset->key, pkey->len);
349 lbs_deb_enter(LBS_DEB_CMD);
353 static int wlan_ret_802_11_mac_address(wlan_private * priv,
354 struct cmd_ds_command *resp)
356 struct cmd_ds_802_11_mac_address *macadd = &resp->params.macadd;
357 wlan_adapter *adapter = priv->adapter;
359 lbs_deb_enter(LBS_DEB_CMD);
361 memcpy(adapter->current_addr, macadd->macadd, ETH_ALEN);
363 lbs_deb_enter(LBS_DEB_CMD);
367 static int wlan_ret_802_11_rf_tx_power(wlan_private * priv,
368 struct cmd_ds_command *resp)
370 struct cmd_ds_802_11_rf_tx_power *rtp = &resp->params.txp;
371 wlan_adapter *adapter = priv->adapter;
373 lbs_deb_enter(LBS_DEB_CMD);
375 adapter->txpowerlevel = le16_to_cpu(rtp->currentlevel);
377 lbs_deb_cmd("TX power currently %d\n", adapter->txpowerlevel);
379 lbs_deb_leave(LBS_DEB_CMD);
383 static int wlan_ret_802_11_rate_adapt_rateset(wlan_private * priv,
384 struct cmd_ds_command *resp)
386 struct cmd_ds_802_11_rate_adapt_rateset *rates = &resp->params.rateset;
387 wlan_adapter *adapter = priv->adapter;
389 lbs_deb_enter(LBS_DEB_CMD);
391 if (rates->action == CMD_ACT_GET) {
392 adapter->enablehwauto = le16_to_cpu(rates->enablehwauto);
393 adapter->ratebitmap = le16_to_cpu(rates->bitmap);
396 lbs_deb_leave(LBS_DEB_CMD);
400 static int wlan_ret_802_11_data_rate(wlan_private * priv,
401 struct cmd_ds_command *resp)
403 struct cmd_ds_802_11_data_rate *pdatarate = &resp->params.drate;
404 wlan_adapter *adapter = priv->adapter;
406 lbs_deb_enter(LBS_DEB_CMD);
408 lbs_deb_hex(LBS_DEB_CMD, "DATA_RATE_RESP", (u8 *) pdatarate,
409 sizeof(struct cmd_ds_802_11_data_rate));
411 /* FIXME: get actual rates FW can do if this command actually returns
412 * all data rates supported.
414 adapter->cur_rate = libertas_fw_index_to_data_rate(pdatarate->rates[0]);
415 lbs_deb_cmd("DATA_RATE: current rate 0x%02x\n", adapter->cur_rate);
417 lbs_deb_leave(LBS_DEB_CMD);
421 static int wlan_ret_802_11_rf_channel(wlan_private * priv,
422 struct cmd_ds_command *resp)
424 struct cmd_ds_802_11_rf_channel *rfchannel = &resp->params.rfchannel;
425 wlan_adapter *adapter = priv->adapter;
426 u16 action = le16_to_cpu(rfchannel->action);
427 u16 newchannel = le16_to_cpu(rfchannel->currentchannel);
429 lbs_deb_enter(LBS_DEB_CMD);
431 if (action == CMD_OPT_802_11_RF_CHANNEL_GET
432 && adapter->curbssparams.channel != newchannel) {
433 lbs_deb_cmd("channel switch from %d to %d\n",
434 adapter->curbssparams.channel, newchannel);
436 /* Update the channel again */
437 adapter->curbssparams.channel = newchannel;
440 lbs_deb_enter(LBS_DEB_CMD);
444 static int wlan_ret_802_11_rssi(wlan_private * priv,
445 struct cmd_ds_command *resp)
447 struct cmd_ds_802_11_rssi_rsp *rssirsp = &resp->params.rssirsp;
448 wlan_adapter *adapter = priv->adapter;
450 lbs_deb_enter(LBS_DEB_CMD);
452 /* store the non average value */
453 adapter->SNR[TYPE_BEACON][TYPE_NOAVG] = le16_to_cpu(rssirsp->SNR);
454 adapter->NF[TYPE_BEACON][TYPE_NOAVG] = le16_to_cpu(rssirsp->noisefloor);
456 adapter->SNR[TYPE_BEACON][TYPE_AVG] = le16_to_cpu(rssirsp->avgSNR);
457 adapter->NF[TYPE_BEACON][TYPE_AVG] = le16_to_cpu(rssirsp->avgnoisefloor);
459 adapter->RSSI[TYPE_BEACON][TYPE_NOAVG] =
460 CAL_RSSI(adapter->SNR[TYPE_BEACON][TYPE_NOAVG],
461 adapter->NF[TYPE_BEACON][TYPE_NOAVG]);
463 adapter->RSSI[TYPE_BEACON][TYPE_AVG] =
464 CAL_RSSI(adapter->SNR[TYPE_BEACON][TYPE_AVG] / AVG_SCALE,
465 adapter->NF[TYPE_BEACON][TYPE_AVG] / AVG_SCALE);
467 lbs_deb_cmd("RSSI: beacon %d, avg %d\n",
468 adapter->RSSI[TYPE_BEACON][TYPE_NOAVG],
469 adapter->RSSI[TYPE_BEACON][TYPE_AVG]);
471 lbs_deb_leave(LBS_DEB_CMD);
475 static int wlan_ret_802_11_eeprom_access(wlan_private * priv,
476 struct cmd_ds_command *resp)
478 wlan_adapter *adapter = priv->adapter;
479 struct wlan_ioctl_regrdwr *pbuf;
480 pbuf = (struct wlan_ioctl_regrdwr *) adapter->prdeeprom;
482 lbs_deb_enter_args(LBS_DEB_CMD, "len %d",
483 le16_to_cpu(resp->params.rdeeprom.bytecount));
484 if (pbuf->NOB < le16_to_cpu(resp->params.rdeeprom.bytecount)) {
486 lbs_deb_cmd("EEPROM read length too big\n");
489 pbuf->NOB = le16_to_cpu(resp->params.rdeeprom.bytecount);
492 memcpy(&pbuf->value, (u8 *) & resp->params.rdeeprom.value,
493 le16_to_cpu(resp->params.rdeeprom.bytecount));
494 lbs_deb_hex(LBS_DEB_CMD, "EEPROM", (char *)&pbuf->value,
495 le16_to_cpu(resp->params.rdeeprom.bytecount));
497 lbs_deb_leave(LBS_DEB_CMD);
501 static int wlan_ret_get_log(wlan_private * priv,
502 struct cmd_ds_command *resp)
504 struct cmd_ds_802_11_get_log *logmessage = &resp->params.glog;
505 wlan_adapter *adapter = priv->adapter;
507 lbs_deb_enter(LBS_DEB_CMD);
509 /* Stored little-endian */
510 memcpy(&adapter->logmsg, logmessage, sizeof(struct cmd_ds_802_11_get_log));
512 lbs_deb_leave(LBS_DEB_CMD);
516 static int libertas_ret_802_11_enable_rsn(wlan_private * priv,
517 struct cmd_ds_command *resp)
519 struct cmd_ds_802_11_enable_rsn *enable_rsn = &resp->params.enbrsn;
520 wlan_adapter *adapter = priv->adapter;
521 u32 * pdata_buf = adapter->cur_cmd->pdata_buf;
523 lbs_deb_enter(LBS_DEB_CMD);
525 if (enable_rsn->action == cpu_to_le16(CMD_ACT_GET)) {
527 *pdata_buf = (u32) le16_to_cpu(enable_rsn->enable);
530 lbs_deb_leave(LBS_DEB_CMD);
534 static inline int handle_cmd_response(u16 respcmd,
535 struct cmd_ds_command *resp,
540 wlan_adapter *adapter = priv->adapter;
542 lbs_deb_enter(LBS_DEB_HOST);
545 case CMD_RET(CMD_MAC_REG_ACCESS):
546 case CMD_RET(CMD_BBP_REG_ACCESS):
547 case CMD_RET(CMD_RF_REG_ACCESS):
548 ret = wlan_ret_reg_access(priv, respcmd, resp);
551 case CMD_RET(CMD_GET_HW_SPEC):
552 ret = wlan_ret_get_hw_spec(priv, resp);
555 case CMD_RET(CMD_802_11_SCAN):
556 ret = libertas_ret_80211_scan(priv, resp);
559 case CMD_RET(CMD_802_11_GET_LOG):
560 ret = wlan_ret_get_log(priv, resp);
563 case CMD_RET_802_11_ASSOCIATE:
564 case CMD_RET(CMD_802_11_ASSOCIATE):
565 case CMD_RET(CMD_802_11_REASSOCIATE):
566 ret = libertas_ret_80211_associate(priv, resp);
569 case CMD_RET(CMD_802_11_DISASSOCIATE):
570 case CMD_RET(CMD_802_11_DEAUTHENTICATE):
571 ret = libertas_ret_80211_disassociate(priv, resp);
574 case CMD_RET(CMD_802_11_AD_HOC_START):
575 case CMD_RET(CMD_802_11_AD_HOC_JOIN):
576 ret = libertas_ret_80211_ad_hoc_start(priv, resp);
579 case CMD_RET(CMD_802_11_GET_STAT):
580 ret = wlan_ret_802_11_stat(priv, resp);
583 case CMD_RET(CMD_802_11_SNMP_MIB):
584 ret = wlan_ret_802_11_snmp_mib(priv, resp);
587 case CMD_RET(CMD_802_11_RF_TX_POWER):
588 ret = wlan_ret_802_11_rf_tx_power(priv, resp);
591 case CMD_RET(CMD_802_11_SET_AFC):
592 case CMD_RET(CMD_802_11_GET_AFC):
593 spin_lock_irqsave(&adapter->driver_lock, flags);
594 memmove(adapter->cur_cmd->pdata_buf, &resp->params.afc,
595 sizeof(struct cmd_ds_802_11_afc));
596 spin_unlock_irqrestore(&adapter->driver_lock, flags);
600 case CMD_RET(CMD_MAC_MULTICAST_ADR):
601 case CMD_RET(CMD_MAC_CONTROL):
602 case CMD_RET(CMD_802_11_SET_WEP):
603 case CMD_RET(CMD_802_11_RESET):
604 case CMD_RET(CMD_802_11_AUTHENTICATE):
605 case CMD_RET(CMD_802_11_RADIO_CONTROL):
606 case CMD_RET(CMD_802_11_BEACON_STOP):
609 case CMD_RET(CMD_802_11_ENABLE_RSN):
610 ret = libertas_ret_802_11_enable_rsn(priv, resp);
613 case CMD_RET(CMD_802_11_DATA_RATE):
614 ret = wlan_ret_802_11_data_rate(priv, resp);
616 case CMD_RET(CMD_802_11_RATE_ADAPT_RATESET):
617 ret = wlan_ret_802_11_rate_adapt_rateset(priv, resp);
619 case CMD_RET(CMD_802_11_RF_CHANNEL):
620 ret = wlan_ret_802_11_rf_channel(priv, resp);
623 case CMD_RET(CMD_802_11_RSSI):
624 ret = wlan_ret_802_11_rssi(priv, resp);
627 case CMD_RET(CMD_802_11_MAC_ADDRESS):
628 ret = wlan_ret_802_11_mac_address(priv, resp);
631 case CMD_RET(CMD_802_11_AD_HOC_STOP):
632 ret = libertas_ret_80211_ad_hoc_stop(priv, resp);
635 case CMD_RET(CMD_802_11_KEY_MATERIAL):
636 ret = wlan_ret_802_11_key_material(priv, resp);
639 case CMD_RET(CMD_802_11_EEPROM_ACCESS):
640 ret = wlan_ret_802_11_eeprom_access(priv, resp);
643 case CMD_RET(CMD_802_11D_DOMAIN_INFO):
644 ret = libertas_ret_802_11d_domain_info(priv, resp);
647 case CMD_RET(CMD_802_11_SLEEP_PARAMS):
648 ret = wlan_ret_802_11_sleep_params(priv, resp);
650 case CMD_RET(CMD_802_11_INACTIVITY_TIMEOUT):
651 spin_lock_irqsave(&adapter->driver_lock, flags);
652 *((u16 *) adapter->cur_cmd->pdata_buf) =
653 le16_to_cpu(resp->params.inactivity_timeout.timeout);
654 spin_unlock_irqrestore(&adapter->driver_lock, flags);
657 case CMD_RET(CMD_802_11_TPC_CFG):
658 spin_lock_irqsave(&adapter->driver_lock, flags);
659 memmove(adapter->cur_cmd->pdata_buf, &resp->params.tpccfg,
660 sizeof(struct cmd_ds_802_11_tpc_cfg));
661 spin_unlock_irqrestore(&adapter->driver_lock, flags);
663 case CMD_RET(CMD_802_11_LED_GPIO_CTRL):
664 spin_lock_irqsave(&adapter->driver_lock, flags);
665 memmove(adapter->cur_cmd->pdata_buf, &resp->params.ledgpio,
666 sizeof(struct cmd_ds_802_11_led_ctrl));
667 spin_unlock_irqrestore(&adapter->driver_lock, flags);
669 case CMD_RET(CMD_802_11_PWR_CFG):
670 spin_lock_irqsave(&adapter->driver_lock, flags);
671 memmove(adapter->cur_cmd->pdata_buf, &resp->params.pwrcfg,
672 sizeof(struct cmd_ds_802_11_pwr_cfg));
673 spin_unlock_irqrestore(&adapter->driver_lock, flags);
677 case CMD_RET(CMD_GET_TSF):
678 spin_lock_irqsave(&adapter->driver_lock, flags);
679 memcpy(priv->adapter->cur_cmd->pdata_buf,
680 &resp->params.gettsf.tsfvalue, sizeof(u64));
681 spin_unlock_irqrestore(&adapter->driver_lock, flags);
683 case CMD_RET(CMD_BT_ACCESS):
684 spin_lock_irqsave(&adapter->driver_lock, flags);
685 if (adapter->cur_cmd->pdata_buf)
686 memcpy(adapter->cur_cmd->pdata_buf,
687 &resp->params.bt.addr1, 2 * ETH_ALEN);
688 spin_unlock_irqrestore(&adapter->driver_lock, flags);
690 case CMD_RET(CMD_FWT_ACCESS):
691 spin_lock_irqsave(&adapter->driver_lock, flags);
692 if (adapter->cur_cmd->pdata_buf)
693 memcpy(adapter->cur_cmd->pdata_buf, &resp->params.fwt,
694 sizeof(resp->params.fwt));
695 spin_unlock_irqrestore(&adapter->driver_lock, flags);
697 case CMD_RET(CMD_MESH_ACCESS):
698 if (adapter->cur_cmd->pdata_buf)
699 memcpy(adapter->cur_cmd->pdata_buf, &resp->params.mesh,
700 sizeof(resp->params.mesh));
703 lbs_deb_host("CMD_RESP: unknown cmd response 0x%04x\n",
707 lbs_deb_leave(LBS_DEB_HOST);
711 int libertas_process_rx_command(wlan_private * priv)
714 struct cmd_ds_command *resp;
715 wlan_adapter *adapter = priv->adapter;
720 lbs_deb_enter(LBS_DEB_HOST);
722 /* Now we got response from FW, cancel the command timer */
723 del_timer(&adapter->command_timer);
725 mutex_lock(&adapter->lock);
726 spin_lock_irqsave(&adapter->driver_lock, flags);
728 if (!adapter->cur_cmd) {
729 lbs_deb_host("CMD_RESP: cur_cmd is NULL\n");
731 spin_unlock_irqrestore(&adapter->driver_lock, flags);
734 resp = (struct cmd_ds_command *)(adapter->cur_cmd->bufvirtualaddr);
736 respcmd = le16_to_cpu(resp->command);
737 result = le16_to_cpu(resp->result);
739 lbs_deb_host("CMD_RESP: response 0x%04x, size %d, jiffies %lu\n",
740 respcmd, priv->upld_len, jiffies);
741 lbs_deb_hex(LBS_DEB_HOST, "CMD_RESP", adapter->cur_cmd->bufvirtualaddr,
744 if (!(respcmd & 0x8000)) {
745 lbs_deb_host("invalid response!\n");
746 adapter->cur_cmd_retcode = -1;
747 __libertas_cleanup_and_insert_cmd(priv, adapter->cur_cmd);
748 adapter->nr_cmd_pending--;
749 adapter->cur_cmd = NULL;
750 spin_unlock_irqrestore(&adapter->driver_lock, flags);
755 /* Store the response code to cur_cmd_retcode. */
756 adapter->cur_cmd_retcode = result;;
758 if (respcmd == CMD_RET(CMD_802_11_PS_MODE)) {
759 struct cmd_ds_802_11_ps_mode *psmode = &resp->params.psmode;
760 u16 action = le16_to_cpu(psmode->action);
763 "CMD_RESP: PS_MODE cmd reply result 0x%x, action 0x%x\n",
767 lbs_deb_host("CMD_RESP: PS command failed with 0x%x\n",
770 * We should not re-try enter-ps command in
771 * ad-hoc mode. It takes place in
772 * libertas_execute_next_command().
774 if (adapter->mode == IW_MODE_ADHOC &&
775 action == CMD_SUBCMD_ENTER_PS)
776 adapter->psmode = WLAN802_11POWERMODECAM;
777 } else if (action == CMD_SUBCMD_ENTER_PS) {
778 adapter->needtowakeup = 0;
779 adapter->psstate = PS_STATE_AWAKE;
781 lbs_deb_host("CMD_RESP: ENTER_PS command response\n");
782 if (adapter->connect_status != LIBERTAS_CONNECTED) {
784 * When Deauth Event received before Enter_PS command
785 * response, We need to wake up the firmware.
788 "disconnected, invoking libertas_ps_wakeup\n");
790 spin_unlock_irqrestore(&adapter->driver_lock, flags);
791 mutex_unlock(&adapter->lock);
792 libertas_ps_wakeup(priv, 0);
793 mutex_lock(&adapter->lock);
794 spin_lock_irqsave(&adapter->driver_lock, flags);
796 } else if (action == CMD_SUBCMD_EXIT_PS) {
797 adapter->needtowakeup = 0;
798 adapter->psstate = PS_STATE_FULL_POWER;
799 lbs_deb_host("CMD_RESP: EXIT_PS command response\n");
801 lbs_deb_host("CMD_RESP: PS action 0x%X\n", action);
804 __libertas_cleanup_and_insert_cmd(priv, adapter->cur_cmd);
805 adapter->nr_cmd_pending--;
806 adapter->cur_cmd = NULL;
807 spin_unlock_irqrestore(&adapter->driver_lock, flags);
813 if (adapter->cur_cmd->cmdflags & CMD_F_HOSTCMD) {
814 /* Copy the response back to response buffer */
815 memcpy(adapter->cur_cmd->pdata_buf, resp, resp->size);
817 adapter->cur_cmd->cmdflags &= ~CMD_F_HOSTCMD;
820 /* If the command is not successful, cleanup and return failure */
821 if ((result != 0 || !(respcmd & 0x8000))) {
822 lbs_deb_host("CMD_RESP: error 0x%04x in command reply 0x%04x\n",
825 * Handling errors here
828 case CMD_RET(CMD_GET_HW_SPEC):
829 case CMD_RET(CMD_802_11_RESET):
830 lbs_deb_host("CMD_RESP: reset failed\n");
835 __libertas_cleanup_and_insert_cmd(priv, adapter->cur_cmd);
836 adapter->nr_cmd_pending--;
837 adapter->cur_cmd = NULL;
838 spin_unlock_irqrestore(&adapter->driver_lock, flags);
844 spin_unlock_irqrestore(&adapter->driver_lock, flags);
846 ret = handle_cmd_response(respcmd, resp, priv);
848 spin_lock_irqsave(&adapter->driver_lock, flags);
849 if (adapter->cur_cmd) {
850 /* Clean up and Put current command back to cmdfreeq */
851 __libertas_cleanup_and_insert_cmd(priv, adapter->cur_cmd);
852 adapter->nr_cmd_pending--;
853 WARN_ON(adapter->nr_cmd_pending > 128);
854 adapter->cur_cmd = NULL;
856 spin_unlock_irqrestore(&adapter->driver_lock, flags);
859 mutex_unlock(&adapter->lock);
860 lbs_deb_leave_args(LBS_DEB_HOST, "ret %d", ret);
864 int libertas_process_event(wlan_private * priv)
867 wlan_adapter *adapter = priv->adapter;
870 lbs_deb_enter(LBS_DEB_CMD);
872 spin_lock_irq(&adapter->driver_lock);
873 eventcause = adapter->eventcause;
874 spin_unlock_irq(&adapter->driver_lock);
876 lbs_deb_cmd("event cause 0x%x\n", eventcause);
878 switch (eventcause >> SBI_EVENT_CAUSE_SHIFT) {
879 case MACREG_INT_CODE_LINK_SENSED:
880 lbs_deb_cmd("EVENT: MACREG_INT_CODE_LINK_SENSED\n");
883 case MACREG_INT_CODE_DEAUTHENTICATED:
884 lbs_deb_cmd("EVENT: deauthenticated\n");
885 libertas_mac_event_disconnected(priv);
888 case MACREG_INT_CODE_DISASSOCIATED:
889 lbs_deb_cmd("EVENT: disassociated\n");
890 libertas_mac_event_disconnected(priv);
893 case MACREG_INT_CODE_LINK_LOSE_NO_SCAN:
894 lbs_deb_cmd("EVENT: link lost\n");
895 libertas_mac_event_disconnected(priv);
898 case MACREG_INT_CODE_PS_SLEEP:
899 lbs_deb_cmd("EVENT: sleep\n");
901 /* handle unexpected PS SLEEP event */
902 if (adapter->psstate == PS_STATE_FULL_POWER) {
904 "EVENT: in FULL POWER mode, ignoreing PS_SLEEP\n");
907 adapter->psstate = PS_STATE_PRE_SLEEP;
909 libertas_ps_confirm_sleep(priv, (u16) adapter->psmode);
913 case MACREG_INT_CODE_PS_AWAKE:
914 lbs_deb_cmd("EVENT: awake\n");
916 /* handle unexpected PS AWAKE event */
917 if (adapter->psstate == PS_STATE_FULL_POWER) {
919 "EVENT: In FULL POWER mode - ignore PS AWAKE\n");
923 adapter->psstate = PS_STATE_AWAKE;
925 if (adapter->needtowakeup) {
927 * wait for the command processing to finish
928 * before resuming sending
929 * adapter->needtowakeup will be set to FALSE
930 * in libertas_ps_wakeup()
932 lbs_deb_cmd("waking up ...\n");
933 libertas_ps_wakeup(priv, 0);
937 case MACREG_INT_CODE_MIC_ERR_UNICAST:
938 lbs_deb_cmd("EVENT: UNICAST MIC ERROR\n");
939 handle_mic_failureevent(priv, MACREG_INT_CODE_MIC_ERR_UNICAST);
942 case MACREG_INT_CODE_MIC_ERR_MULTICAST:
943 lbs_deb_cmd("EVENT: MULTICAST MIC ERROR\n");
944 handle_mic_failureevent(priv, MACREG_INT_CODE_MIC_ERR_MULTICAST);
946 case MACREG_INT_CODE_MIB_CHANGED:
947 case MACREG_INT_CODE_INIT_DONE:
950 case MACREG_INT_CODE_ADHOC_BCN_LOST:
951 lbs_deb_cmd("EVENT: ADHOC beacon lost\n");
954 case MACREG_INT_CODE_RSSI_LOW:
955 lbs_pr_alert("EVENT: rssi low\n");
957 case MACREG_INT_CODE_SNR_LOW:
958 lbs_pr_alert("EVENT: snr low\n");
960 case MACREG_INT_CODE_MAX_FAIL:
961 lbs_pr_alert("EVENT: max fail\n");
963 case MACREG_INT_CODE_RSSI_HIGH:
964 lbs_pr_alert("EVENT: rssi high\n");
966 case MACREG_INT_CODE_SNR_HIGH:
967 lbs_pr_alert("EVENT: snr high\n");
970 case MACREG_INT_CODE_MESH_AUTO_STARTED:
971 lbs_pr_info("EVENT: MESH_AUTO_STARTED\n");
972 adapter->connect_status = LIBERTAS_CONNECTED;
973 if (priv->mesh_open == 1) {
974 netif_wake_queue(priv->mesh_dev);
975 netif_carrier_on(priv->mesh_dev);
977 adapter->mode = IW_MODE_ADHOC;
978 schedule_work(&priv->sync_channel);
982 lbs_pr_alert("EVENT: unknown event id 0x%04x\n",
983 eventcause >> SBI_EVENT_CAUSE_SHIFT);
987 spin_lock_irq(&adapter->driver_lock);
988 adapter->eventcause = 0;
989 spin_unlock_irq(&adapter->driver_lock);
991 lbs_deb_leave_args(LBS_DEB_CMD, "ret %d", ret);