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);