]>
Commit | Line | Data |
---|---|---|
876c9d3a MT |
1 | /** |
2 | * This file contains the handling of command | |
3 | * responses as well as events generated by firmware. | |
4 | */ | |
5 | #include <linux/delay.h> | |
6 | #include <linux/if_arp.h> | |
7 | #include <linux/netdevice.h> | |
8 | ||
9 | #include <net/iw_handler.h> | |
10 | ||
11 | #include "host.h" | |
876c9d3a MT |
12 | #include "decl.h" |
13 | #include "defs.h" | |
14 | #include "dev.h" | |
15 | #include "join.h" | |
16 | #include "wext.h" | |
17 | ||
18 | /** | |
19 | * @brief This function handles disconnect event. it | |
20 | * reports disconnect to upper layer, clean tx/rx packets, | |
21 | * reset link state etc. | |
22 | * | |
23 | * @param priv A pointer to wlan_private structure | |
24 | * @return n/a | |
25 | */ | |
26 | void libertas_mac_event_disconnected(wlan_private * priv) | |
27 | { | |
28 | wlan_adapter *adapter = priv->adapter; | |
29 | union iwreq_data wrqu; | |
30 | ||
0aef64d7 | 31 | if (adapter->connect_status != LIBERTAS_CONNECTED) |
876c9d3a MT |
32 | return; |
33 | ||
a6c8700f | 34 | lbs_deb_enter(LBS_DEB_CMD); |
876c9d3a MT |
35 | |
36 | memset(wrqu.ap_addr.sa_data, 0x00, ETH_ALEN); | |
37 | wrqu.ap_addr.sa_family = ARPHRD_ETHER; | |
38 | ||
39 | /* | |
40 | * Cisco AP sends EAP failure and de-auth in less than 0.5 ms. | |
41 | * It causes problem in the Supplicant | |
42 | */ | |
43 | ||
44 | msleep_interruptible(1000); | |
634b8f49 | 45 | wireless_send_event(priv->dev, SIOCGIWAP, &wrqu, NULL); |
876c9d3a MT |
46 | |
47 | /* Free Tx and Rx packets */ | |
48 | kfree_skb(priv->adapter->currenttxskb); | |
49 | priv->adapter->currenttxskb = NULL; | |
50 | ||
51 | /* report disconnect to upper layer */ | |
634b8f49 HS |
52 | netif_stop_queue(priv->dev); |
53 | netif_carrier_off(priv->dev); | |
876c9d3a MT |
54 | |
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; | |
a6c8700f | 63 | lbs_deb_cmd("current SSID '%s', length %u\n", |
d8efea25 DW |
64 | escape_essid(adapter->curbssparams.ssid, |
65 | adapter->curbssparams.ssid_len), | |
66 | adapter->curbssparams.ssid_len); | |
876c9d3a | 67 | |
0aef64d7 | 68 | adapter->connect_status = LIBERTAS_DISCONNECTED; |
876c9d3a | 69 | |
e76850d6 DW |
70 | /* Clear out associated SSID and BSSID since connection is |
71 | * no longer valid. | |
72 | */ | |
73 | memset(&adapter->curbssparams.bssid, 0, ETH_ALEN); | |
d8efea25 DW |
74 | memset(&adapter->curbssparams.ssid, 0, IW_ESSID_MAX_SIZE); |
75 | adapter->curbssparams.ssid_len = 0; | |
876c9d3a MT |
76 | |
77 | if (adapter->psstate != PS_STATE_FULL_POWER) { | |
78 | /* make firmware to exit PS mode */ | |
a6c8700f | 79 | lbs_deb_cmd("disconnected, so exit PS mode\n"); |
876c9d3a MT |
80 | libertas_ps_wakeup(priv, 0); |
81 | } | |
a6c8700f | 82 | lbs_deb_leave(LBS_DEB_CMD); |
876c9d3a MT |
83 | } |
84 | ||
85 | /** | |
86 | * @brief This function handles MIC failure event. | |
87 | * | |
88 | * @param priv A pointer to wlan_private structure | |
89 | * @para event the event id | |
90 | * @return n/a | |
91 | */ | |
92 | static void handle_mic_failureevent(wlan_private * priv, u32 event) | |
93 | { | |
94 | char buf[50]; | |
95 | ||
a6c8700f | 96 | lbs_deb_enter(LBS_DEB_CMD); |
876c9d3a MT |
97 | memset(buf, 0, sizeof(buf)); |
98 | ||
99 | sprintf(buf, "%s", "MLME-MICHAELMICFAILURE.indication "); | |
100 | ||
101 | if (event == MACREG_INT_CODE_MIC_ERR_UNICAST) { | |
102 | strcat(buf, "unicast "); | |
103 | } else { | |
104 | strcat(buf, "multicast "); | |
105 | } | |
106 | ||
107 | libertas_send_iwevcustom_event(priv, buf); | |
a6c8700f | 108 | lbs_deb_leave(LBS_DEB_CMD); |
876c9d3a MT |
109 | } |
110 | ||
111 | static int wlan_ret_reg_access(wlan_private * priv, | |
112 | u16 type, struct cmd_ds_command *resp) | |
113 | { | |
9012b28a | 114 | int ret = 0; |
876c9d3a MT |
115 | wlan_adapter *adapter = priv->adapter; |
116 | ||
9012b28a | 117 | lbs_deb_enter(LBS_DEB_CMD); |
876c9d3a MT |
118 | |
119 | switch (type) { | |
6b63cd0f | 120 | case CMD_RET(CMD_MAC_REG_ACCESS): |
876c9d3a | 121 | { |
981f187b | 122 | struct cmd_ds_mac_reg_access *reg = &resp->params.macreg; |
876c9d3a | 123 | |
981f187b DW |
124 | adapter->offsetvalue.offset = (u32)le16_to_cpu(reg->offset); |
125 | adapter->offsetvalue.value = le32_to_cpu(reg->value); | |
876c9d3a MT |
126 | break; |
127 | } | |
128 | ||
6b63cd0f | 129 | case CMD_RET(CMD_BBP_REG_ACCESS): |
876c9d3a | 130 | { |
981f187b | 131 | struct cmd_ds_bbp_reg_access *reg = &resp->params.bbpreg; |
876c9d3a | 132 | |
981f187b | 133 | adapter->offsetvalue.offset = (u32)le16_to_cpu(reg->offset); |
876c9d3a MT |
134 | adapter->offsetvalue.value = reg->value; |
135 | break; | |
136 | } | |
137 | ||
6b63cd0f | 138 | case CMD_RET(CMD_RF_REG_ACCESS): |
876c9d3a | 139 | { |
981f187b | 140 | struct cmd_ds_rf_reg_access *reg = &resp->params.rfreg; |
876c9d3a | 141 | |
981f187b | 142 | adapter->offsetvalue.offset = (u32)le16_to_cpu(reg->offset); |
876c9d3a MT |
143 | adapter->offsetvalue.value = reg->value; |
144 | break; | |
145 | } | |
146 | ||
147 | default: | |
9012b28a | 148 | ret = -1; |
876c9d3a MT |
149 | } |
150 | ||
9012b28a HS |
151 | lbs_deb_enter_args(LBS_DEB_CMD, "ret %d", ret); |
152 | return ret; | |
876c9d3a MT |
153 | } |
154 | ||
155 | static int wlan_ret_get_hw_spec(wlan_private * priv, | |
156 | struct cmd_ds_command *resp) | |
157 | { | |
158 | u32 i; | |
159 | struct cmd_ds_get_hw_spec *hwspec = &resp->params.hwspec; | |
160 | wlan_adapter *adapter = priv->adapter; | |
161 | int ret = 0; | |
162 | ||
9012b28a | 163 | lbs_deb_enter(LBS_DEB_CMD); |
876c9d3a MT |
164 | |
165 | adapter->fwcapinfo = le32_to_cpu(hwspec->fwcapinfo); | |
166 | ||
e5b3d472 | 167 | memcpy(adapter->fwreleasenumber, hwspec->fwreleasenumber, 4); |
876c9d3a | 168 | |
a6c8700f | 169 | lbs_deb_cmd("GET_HW_SPEC: firmware release %u.%u.%up%u\n", |
e5b3d472 DW |
170 | adapter->fwreleasenumber[2], adapter->fwreleasenumber[1], |
171 | adapter->fwreleasenumber[0], adapter->fwreleasenumber[3]); | |
a6c8700f | 172 | lbs_deb_cmd("GET_HW_SPEC: MAC addr " MAC_FMT "\n", |
0a6d0555 | 173 | MAC_ARG(hwspec->permanentaddr)); |
a6c8700f | 174 | lbs_deb_cmd("GET_HW_SPEC: hardware interface 0x%x, hardware spec 0x%04x\n", |
876c9d3a MT |
175 | hwspec->hwifversion, hwspec->version); |
176 | ||
177 | adapter->regioncode = le16_to_cpu(hwspec->regioncode); | |
178 | ||
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]) { | |
876c9d3a MT |
182 | break; |
183 | } | |
184 | } | |
185 | ||
186 | /* if it's unidentified region code, use the default (USA) */ | |
187 | if (i >= MRVDRV_MAX_REGION_CODE) { | |
188 | adapter->regioncode = 0x10; | |
981f187b | 189 | lbs_pr_info("unidentified region code; using the default (USA)\n"); |
876c9d3a MT |
190 | } |
191 | ||
981f187b DW |
192 | if (adapter->current_addr[0] == 0xff) |
193 | memmove(adapter->current_addr, hwspec->permanentaddr, ETH_ALEN); | |
876c9d3a | 194 | |
634b8f49 | 195 | memcpy(priv->dev->dev_addr, adapter->current_addr, ETH_ALEN); |
78523daa | 196 | if (priv->mesh_dev) |
981f187b | 197 | memcpy(priv->mesh_dev->dev_addr, adapter->current_addr, ETH_ALEN); |
876c9d3a MT |
198 | |
199 | if (libertas_set_regiontable(priv, adapter->regioncode, 0)) { | |
200 | ret = -1; | |
201 | goto done; | |
202 | } | |
203 | ||
204 | if (libertas_set_universaltable(priv, 0)) { | |
205 | ret = -1; | |
206 | goto done; | |
207 | } | |
208 | ||
9012b28a HS |
209 | done: |
210 | lbs_deb_enter_args(LBS_DEB_CMD, "ret %d", ret); | |
876c9d3a MT |
211 | return ret; |
212 | } | |
213 | ||
214 | static int wlan_ret_802_11_sleep_params(wlan_private * priv, | |
215 | struct cmd_ds_command *resp) | |
216 | { | |
217 | struct cmd_ds_802_11_sleep_params *sp = &resp->params.sleep_params; | |
218 | wlan_adapter *adapter = priv->adapter; | |
219 | ||
9012b28a | 220 | lbs_deb_enter(LBS_DEB_CMD); |
876c9d3a | 221 | |
a6c8700f HS |
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), | |
981f187b DW |
224 | le16_to_cpu(sp->offset), le16_to_cpu(sp->stabletime), |
225 | sp->calcontrol, sp->externalsleepclk); | |
226 | ||
876c9d3a MT |
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); | |
981f187b DW |
230 | adapter->sp.sp_calcontrol = sp->calcontrol; |
231 | adapter->sp.sp_extsleepclk = sp->externalsleepclk; | |
876c9d3a MT |
232 | adapter->sp.sp_reserved = le16_to_cpu(sp->reserved); |
233 | ||
9012b28a | 234 | lbs_deb_enter(LBS_DEB_CMD); |
876c9d3a MT |
235 | return 0; |
236 | } | |
237 | ||
238 | static int wlan_ret_802_11_stat(wlan_private * priv, | |
239 | struct cmd_ds_command *resp) | |
240 | { | |
a6c8700f | 241 | lbs_deb_enter(LBS_DEB_CMD); |
876c9d3a MT |
242 | /* currently adapter->wlan802_11Stat is unused |
243 | ||
244 | struct cmd_ds_802_11_get_stat *p11Stat = &resp->params.gstat; | |
245 | wlan_adapter *adapter = priv->adapter; | |
246 | ||
247 | // TODO Convert it to Big endian befor copy | |
248 | memcpy(&adapter->wlan802_11Stat, | |
249 | p11Stat, sizeof(struct cmd_ds_802_11_get_stat)); | |
250 | */ | |
a6c8700f | 251 | lbs_deb_leave(LBS_DEB_CMD); |
876c9d3a MT |
252 | return 0; |
253 | } | |
254 | ||
255 | static int wlan_ret_802_11_snmp_mib(wlan_private * priv, | |
256 | struct cmd_ds_command *resp) | |
257 | { | |
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); | |
261 | ||
9012b28a | 262 | lbs_deb_enter(LBS_DEB_CMD); |
876c9d3a | 263 | |
a6c8700f | 264 | lbs_deb_cmd("SNMP_RESP: oid 0x%x, querytype 0x%x\n", oid, |
876c9d3a | 265 | querytype); |
a6c8700f | 266 | lbs_deb_cmd("SNMP_RESP: Buf size %d\n", le16_to_cpu(smib->bufsize)); |
876c9d3a | 267 | |
0aef64d7 | 268 | if (querytype == CMD_ACT_GET) { |
876c9d3a | 269 | switch (oid) { |
0aef64d7 | 270 | case FRAGTHRESH_I: |
876c9d3a | 271 | priv->adapter->fragthsd = |
981f187b | 272 | le16_to_cpu(*((__le16 *)(smib->value))); |
a6c8700f | 273 | lbs_deb_cmd("SNMP_RESP: frag threshold %u\n", |
981f187b | 274 | priv->adapter->fragthsd); |
876c9d3a | 275 | break; |
0aef64d7 | 276 | case RTSTHRESH_I: |
876c9d3a | 277 | priv->adapter->rtsthsd = |
981f187b | 278 | le16_to_cpu(*((__le16 *)(smib->value))); |
a6c8700f | 279 | lbs_deb_cmd("SNMP_RESP: rts threshold %u\n", |
981f187b | 280 | priv->adapter->rtsthsd); |
876c9d3a | 281 | break; |
0aef64d7 | 282 | case SHORT_RETRYLIM_I: |
876c9d3a | 283 | priv->adapter->txretrycount = |
981f187b | 284 | le16_to_cpu(*((__le16 *)(smib->value))); |
a6c8700f | 285 | lbs_deb_cmd("SNMP_RESP: tx retry count %u\n", |
981f187b | 286 | priv->adapter->rtsthsd); |
876c9d3a MT |
287 | break; |
288 | default: | |
289 | break; | |
290 | } | |
291 | } | |
292 | ||
9012b28a | 293 | lbs_deb_enter(LBS_DEB_CMD); |
876c9d3a MT |
294 | return 0; |
295 | } | |
296 | ||
297 | static int wlan_ret_802_11_key_material(wlan_private * priv, | |
298 | struct cmd_ds_command *resp) | |
299 | { | |
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); | |
304 | ||
9012b28a | 305 | lbs_deb_enter(LBS_DEB_CMD); |
876c9d3a MT |
306 | |
307 | /* Copy the returned key to driver private data */ | |
0aef64d7 | 308 | if (action == CMD_ACT_GET) { |
876c9d3a MT |
309 | u8 * buf_ptr = (u8 *) &pkeymaterial->keyParamSet; |
310 | u8 * resp_end = (u8 *) (resp + le16_to_cpu(resp->size)); | |
311 | ||
312 | while (buf_ptr < resp_end) { | |
313 | struct MrvlIEtype_keyParamSet * pkeyparamset = | |
314 | (struct MrvlIEtype_keyParamSet *) buf_ptr; | |
1443b653 | 315 | struct enc_key * pkey; |
876c9d3a | 316 | u16 param_set_len = le16_to_cpu(pkeyparamset->length); |
876c9d3a | 317 | u16 key_len = le16_to_cpu(pkeyparamset->keylen); |
1443b653 DW |
318 | u16 key_flags = le16_to_cpu(pkeyparamset->keyinfo); |
319 | u16 key_type = le16_to_cpu(pkeyparamset->keytypeid); | |
320 | u8 * end; | |
876c9d3a MT |
321 | |
322 | end = (u8 *) pkeyparamset + sizeof (pkeyparamset->type) | |
323 | + sizeof (pkeyparamset->length) | |
324 | + param_set_len; | |
325 | /* Make sure we don't access past the end of the IEs */ | |
326 | if (end > resp_end) | |
327 | break; | |
328 | ||
1443b653 | 329 | if (key_flags & KEY_INFO_WPA_UNICAST) |
876c9d3a | 330 | pkey = &adapter->wpa_unicast_key; |
1443b653 | 331 | else if (key_flags & KEY_INFO_WPA_MCAST) |
876c9d3a MT |
332 | pkey = &adapter->wpa_mcast_key; |
333 | else | |
334 | break; | |
335 | ||
336 | /* Copy returned key into driver */ | |
1443b653 | 337 | memset(pkey, 0, sizeof(struct enc_key)); |
876c9d3a MT |
338 | if (key_len > sizeof(pkey->key)) |
339 | break; | |
1443b653 DW |
340 | pkey->type = key_type; |
341 | pkey->flags = key_flags; | |
342 | pkey->len = key_len; | |
876c9d3a MT |
343 | memcpy(pkey->key, pkeyparamset->key, pkey->len); |
344 | ||
345 | buf_ptr = end + 1; | |
346 | } | |
347 | } | |
348 | ||
9012b28a | 349 | lbs_deb_enter(LBS_DEB_CMD); |
876c9d3a MT |
350 | return 0; |
351 | } | |
352 | ||
353 | static int wlan_ret_802_11_mac_address(wlan_private * priv, | |
354 | struct cmd_ds_command *resp) | |
355 | { | |
356 | struct cmd_ds_802_11_mac_address *macadd = &resp->params.macadd; | |
357 | wlan_adapter *adapter = priv->adapter; | |
358 | ||
9012b28a | 359 | lbs_deb_enter(LBS_DEB_CMD); |
876c9d3a MT |
360 | |
361 | memcpy(adapter->current_addr, macadd->macadd, ETH_ALEN); | |
362 | ||
9012b28a | 363 | lbs_deb_enter(LBS_DEB_CMD); |
876c9d3a MT |
364 | return 0; |
365 | } | |
366 | ||
367 | static int wlan_ret_802_11_rf_tx_power(wlan_private * priv, | |
368 | struct cmd_ds_command *resp) | |
369 | { | |
370 | struct cmd_ds_802_11_rf_tx_power *rtp = &resp->params.txp; | |
371 | wlan_adapter *adapter = priv->adapter; | |
372 | ||
9012b28a | 373 | lbs_deb_enter(LBS_DEB_CMD); |
876c9d3a MT |
374 | |
375 | adapter->txpowerlevel = le16_to_cpu(rtp->currentlevel); | |
376 | ||
a6c8700f | 377 | lbs_deb_cmd("TX power currently %d\n", adapter->txpowerlevel); |
876c9d3a | 378 | |
a6c8700f | 379 | lbs_deb_leave(LBS_DEB_CMD); |
876c9d3a MT |
380 | return 0; |
381 | } | |
382 | ||
876c9d3a MT |
383 | static int wlan_ret_802_11_rate_adapt_rateset(wlan_private * priv, |
384 | struct cmd_ds_command *resp) | |
385 | { | |
981f187b | 386 | struct cmd_ds_802_11_rate_adapt_rateset *rates = &resp->params.rateset; |
876c9d3a MT |
387 | wlan_adapter *adapter = priv->adapter; |
388 | ||
9012b28a | 389 | lbs_deb_enter(LBS_DEB_CMD); |
876c9d3a | 390 | |
0aef64d7 | 391 | if (rates->action == CMD_ACT_GET) { |
981f187b DW |
392 | adapter->enablehwauto = le16_to_cpu(rates->enablehwauto); |
393 | adapter->ratebitmap = le16_to_cpu(rates->bitmap); | |
876c9d3a MT |
394 | } |
395 | ||
a6c8700f | 396 | lbs_deb_leave(LBS_DEB_CMD); |
876c9d3a MT |
397 | return 0; |
398 | } | |
399 | ||
400 | static int wlan_ret_802_11_data_rate(wlan_private * priv, | |
401 | struct cmd_ds_command *resp) | |
402 | { | |
403 | struct cmd_ds_802_11_data_rate *pdatarate = &resp->params.drate; | |
404 | wlan_adapter *adapter = priv->adapter; | |
876c9d3a | 405 | |
9012b28a | 406 | lbs_deb_enter(LBS_DEB_CMD); |
876c9d3a | 407 | |
a6c8700f | 408 | lbs_deb_hex(LBS_DEB_CMD, "DATA_RATE_RESP", (u8 *) pdatarate, |
8c512765 | 409 | sizeof(struct cmd_ds_802_11_data_rate)); |
876c9d3a | 410 | |
8c512765 DW |
411 | /* FIXME: get actual rates FW can do if this command actually returns |
412 | * all data rates supported. | |
413 | */ | |
414 | adapter->cur_rate = libertas_fw_index_to_data_rate(pdatarate->rates[0]); | |
a6c8700f | 415 | lbs_deb_cmd("DATA_RATE: current rate 0x%02x\n", adapter->cur_rate); |
876c9d3a | 416 | |
8c512765 | 417 | lbs_deb_leave(LBS_DEB_CMD); |
876c9d3a MT |
418 | return 0; |
419 | } | |
420 | ||
421 | static int wlan_ret_802_11_rf_channel(wlan_private * priv, | |
422 | struct cmd_ds_command *resp) | |
423 | { | |
981f187b | 424 | struct cmd_ds_802_11_rf_channel *rfchannel = &resp->params.rfchannel; |
876c9d3a MT |
425 | wlan_adapter *adapter = priv->adapter; |
426 | u16 action = le16_to_cpu(rfchannel->action); | |
427 | u16 newchannel = le16_to_cpu(rfchannel->currentchannel); | |
428 | ||
9012b28a | 429 | lbs_deb_enter(LBS_DEB_CMD); |
876c9d3a | 430 | |
0aef64d7 | 431 | if (action == CMD_OPT_802_11_RF_CHANNEL_GET |
876c9d3a | 432 | && adapter->curbssparams.channel != newchannel) { |
a6c8700f | 433 | lbs_deb_cmd("channel switch from %d to %d\n", |
876c9d3a MT |
434 | adapter->curbssparams.channel, newchannel); |
435 | ||
436 | /* Update the channel again */ | |
437 | adapter->curbssparams.channel = newchannel; | |
438 | } | |
439 | ||
9012b28a | 440 | lbs_deb_enter(LBS_DEB_CMD); |
876c9d3a MT |
441 | return 0; |
442 | } | |
443 | ||
444 | static int wlan_ret_802_11_rssi(wlan_private * priv, | |
445 | struct cmd_ds_command *resp) | |
446 | { | |
447 | struct cmd_ds_802_11_rssi_rsp *rssirsp = &resp->params.rssirsp; | |
448 | wlan_adapter *adapter = priv->adapter; | |
449 | ||
a6c8700f HS |
450 | lbs_deb_enter(LBS_DEB_CMD); |
451 | ||
876c9d3a MT |
452 | /* store the non average value */ |
453 | adapter->SNR[TYPE_BEACON][TYPE_NOAVG] = le16_to_cpu(rssirsp->SNR); | |
981f187b | 454 | adapter->NF[TYPE_BEACON][TYPE_NOAVG] = le16_to_cpu(rssirsp->noisefloor); |
876c9d3a MT |
455 | |
456 | adapter->SNR[TYPE_BEACON][TYPE_AVG] = le16_to_cpu(rssirsp->avgSNR); | |
981f187b | 457 | adapter->NF[TYPE_BEACON][TYPE_AVG] = le16_to_cpu(rssirsp->avgnoisefloor); |
876c9d3a MT |
458 | |
459 | adapter->RSSI[TYPE_BEACON][TYPE_NOAVG] = | |
460 | CAL_RSSI(adapter->SNR[TYPE_BEACON][TYPE_NOAVG], | |
461 | adapter->NF[TYPE_BEACON][TYPE_NOAVG]); | |
462 | ||
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); | |
466 | ||
a6c8700f HS |
467 | lbs_deb_cmd("RSSI: beacon %d, avg %d\n", |
468 | adapter->RSSI[TYPE_BEACON][TYPE_NOAVG], | |
876c9d3a MT |
469 | adapter->RSSI[TYPE_BEACON][TYPE_AVG]); |
470 | ||
a6c8700f | 471 | lbs_deb_leave(LBS_DEB_CMD); |
876c9d3a MT |
472 | return 0; |
473 | } | |
474 | ||
475 | static int wlan_ret_802_11_eeprom_access(wlan_private * priv, | |
476 | struct cmd_ds_command *resp) | |
477 | { | |
478 | wlan_adapter *adapter = priv->adapter; | |
479 | struct wlan_ioctl_regrdwr *pbuf; | |
480 | pbuf = (struct wlan_ioctl_regrdwr *) adapter->prdeeprom; | |
481 | ||
a6c8700f | 482 | lbs_deb_enter_args(LBS_DEB_CMD, "len %d", |
876c9d3a MT |
483 | le16_to_cpu(resp->params.rdeeprom.bytecount)); |
484 | if (pbuf->NOB < le16_to_cpu(resp->params.rdeeprom.bytecount)) { | |
485 | pbuf->NOB = 0; | |
a6c8700f | 486 | lbs_deb_cmd("EEPROM read length too big\n"); |
876c9d3a MT |
487 | return -1; |
488 | } | |
489 | pbuf->NOB = le16_to_cpu(resp->params.rdeeprom.bytecount); | |
490 | if (pbuf->NOB > 0) { | |
491 | ||
492 | memcpy(&pbuf->value, (u8 *) & resp->params.rdeeprom.value, | |
493 | le16_to_cpu(resp->params.rdeeprom.bytecount)); | |
a6c8700f | 494 | lbs_deb_hex(LBS_DEB_CMD, "EEPROM", (char *)&pbuf->value, |
876c9d3a MT |
495 | le16_to_cpu(resp->params.rdeeprom.bytecount)); |
496 | } | |
a6c8700f | 497 | lbs_deb_leave(LBS_DEB_CMD); |
876c9d3a MT |
498 | return 0; |
499 | } | |
500 | ||
501 | static int wlan_ret_get_log(wlan_private * priv, | |
502 | struct cmd_ds_command *resp) | |
503 | { | |
981f187b | 504 | struct cmd_ds_802_11_get_log *logmessage = &resp->params.glog; |
876c9d3a MT |
505 | wlan_adapter *adapter = priv->adapter; |
506 | ||
9012b28a | 507 | lbs_deb_enter(LBS_DEB_CMD); |
876c9d3a | 508 | |
981f187b DW |
509 | /* Stored little-endian */ |
510 | memcpy(&adapter->logmsg, logmessage, sizeof(struct cmd_ds_802_11_get_log)); | |
876c9d3a | 511 | |
a6c8700f | 512 | lbs_deb_leave(LBS_DEB_CMD); |
876c9d3a MT |
513 | return 0; |
514 | } | |
515 | ||
18c96c34 DW |
516 | static int libertas_ret_802_11_enable_rsn(wlan_private * priv, |
517 | struct cmd_ds_command *resp) | |
518 | { | |
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; | |
522 | ||
523 | lbs_deb_enter(LBS_DEB_CMD); | |
524 | ||
0aef64d7 | 525 | if (enable_rsn->action == cpu_to_le16(CMD_ACT_GET)) { |
18c96c34 DW |
526 | if (pdata_buf) |
527 | *pdata_buf = (u32) le16_to_cpu(enable_rsn->enable); | |
528 | } | |
529 | ||
a6c8700f | 530 | lbs_deb_leave(LBS_DEB_CMD); |
18c96c34 DW |
531 | return 0; |
532 | } | |
533 | ||
876c9d3a MT |
534 | static inline int handle_cmd_response(u16 respcmd, |
535 | struct cmd_ds_command *resp, | |
536 | wlan_private *priv) | |
537 | { | |
538 | int ret = 0; | |
539 | unsigned long flags; | |
540 | wlan_adapter *adapter = priv->adapter; | |
541 | ||
a6c8700f HS |
542 | lbs_deb_enter(LBS_DEB_HOST); |
543 | ||
876c9d3a | 544 | switch (respcmd) { |
6b63cd0f HS |
545 | case CMD_RET(CMD_MAC_REG_ACCESS): |
546 | case CMD_RET(CMD_BBP_REG_ACCESS): | |
547 | case CMD_RET(CMD_RF_REG_ACCESS): | |
876c9d3a MT |
548 | ret = wlan_ret_reg_access(priv, respcmd, resp); |
549 | break; | |
550 | ||
6b63cd0f | 551 | case CMD_RET(CMD_GET_HW_SPEC): |
876c9d3a MT |
552 | ret = wlan_ret_get_hw_spec(priv, resp); |
553 | break; | |
554 | ||
6b63cd0f | 555 | case CMD_RET(CMD_802_11_SCAN): |
876c9d3a MT |
556 | ret = libertas_ret_80211_scan(priv, resp); |
557 | break; | |
558 | ||
6b63cd0f | 559 | case CMD_RET(CMD_802_11_GET_LOG): |
876c9d3a MT |
560 | ret = wlan_ret_get_log(priv, resp); |
561 | break; | |
562 | ||
0aef64d7 | 563 | case CMD_RET_802_11_ASSOCIATE: |
6b63cd0f HS |
564 | case CMD_RET(CMD_802_11_ASSOCIATE): |
565 | case CMD_RET(CMD_802_11_REASSOCIATE): | |
876c9d3a MT |
566 | ret = libertas_ret_80211_associate(priv, resp); |
567 | break; | |
568 | ||
6b63cd0f HS |
569 | case CMD_RET(CMD_802_11_DISASSOCIATE): |
570 | case CMD_RET(CMD_802_11_DEAUTHENTICATE): | |
876c9d3a MT |
571 | ret = libertas_ret_80211_disassociate(priv, resp); |
572 | break; | |
573 | ||
6b63cd0f HS |
574 | case CMD_RET(CMD_802_11_AD_HOC_START): |
575 | case CMD_RET(CMD_802_11_AD_HOC_JOIN): | |
876c9d3a MT |
576 | ret = libertas_ret_80211_ad_hoc_start(priv, resp); |
577 | break; | |
578 | ||
6b63cd0f | 579 | case CMD_RET(CMD_802_11_GET_STAT): |
876c9d3a MT |
580 | ret = wlan_ret_802_11_stat(priv, resp); |
581 | break; | |
582 | ||
6b63cd0f | 583 | case CMD_RET(CMD_802_11_SNMP_MIB): |
876c9d3a MT |
584 | ret = wlan_ret_802_11_snmp_mib(priv, resp); |
585 | break; | |
586 | ||
6b63cd0f | 587 | case CMD_RET(CMD_802_11_RF_TX_POWER): |
876c9d3a MT |
588 | ret = wlan_ret_802_11_rf_tx_power(priv, resp); |
589 | break; | |
590 | ||
6b63cd0f HS |
591 | case CMD_RET(CMD_802_11_SET_AFC): |
592 | case CMD_RET(CMD_802_11_GET_AFC): | |
876c9d3a | 593 | spin_lock_irqsave(&adapter->driver_lock, flags); |
981f187b | 594 | memmove(adapter->cur_cmd->pdata_buf, &resp->params.afc, |
876c9d3a MT |
595 | sizeof(struct cmd_ds_802_11_afc)); |
596 | spin_unlock_irqrestore(&adapter->driver_lock, flags); | |
597 | ||
598 | break; | |
876c9d3a | 599 | |
6b63cd0f HS |
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): | |
18c96c34 DW |
607 | break; |
608 | ||
6b63cd0f | 609 | case CMD_RET(CMD_802_11_ENABLE_RSN): |
18c96c34 | 610 | ret = libertas_ret_802_11_enable_rsn(priv, resp); |
876c9d3a MT |
611 | break; |
612 | ||
6b63cd0f | 613 | case CMD_RET(CMD_802_11_DATA_RATE): |
876c9d3a MT |
614 | ret = wlan_ret_802_11_data_rate(priv, resp); |
615 | break; | |
6b63cd0f | 616 | case CMD_RET(CMD_802_11_RATE_ADAPT_RATESET): |
876c9d3a MT |
617 | ret = wlan_ret_802_11_rate_adapt_rateset(priv, resp); |
618 | break; | |
6b63cd0f | 619 | case CMD_RET(CMD_802_11_RF_CHANNEL): |
876c9d3a MT |
620 | ret = wlan_ret_802_11_rf_channel(priv, resp); |
621 | break; | |
622 | ||
6b63cd0f | 623 | case CMD_RET(CMD_802_11_RSSI): |
876c9d3a MT |
624 | ret = wlan_ret_802_11_rssi(priv, resp); |
625 | break; | |
626 | ||
6b63cd0f | 627 | case CMD_RET(CMD_802_11_MAC_ADDRESS): |
876c9d3a MT |
628 | ret = wlan_ret_802_11_mac_address(priv, resp); |
629 | break; | |
630 | ||
6b63cd0f | 631 | case CMD_RET(CMD_802_11_AD_HOC_STOP): |
876c9d3a MT |
632 | ret = libertas_ret_80211_ad_hoc_stop(priv, resp); |
633 | break; | |
634 | ||
6b63cd0f | 635 | case CMD_RET(CMD_802_11_KEY_MATERIAL): |
876c9d3a MT |
636 | ret = wlan_ret_802_11_key_material(priv, resp); |
637 | break; | |
638 | ||
6b63cd0f | 639 | case CMD_RET(CMD_802_11_EEPROM_ACCESS): |
876c9d3a MT |
640 | ret = wlan_ret_802_11_eeprom_access(priv, resp); |
641 | break; | |
642 | ||
6b63cd0f | 643 | case CMD_RET(CMD_802_11D_DOMAIN_INFO): |
876c9d3a MT |
644 | ret = libertas_ret_802_11d_domain_info(priv, resp); |
645 | break; | |
646 | ||
6b63cd0f | 647 | case CMD_RET(CMD_802_11_SLEEP_PARAMS): |
876c9d3a MT |
648 | ret = wlan_ret_802_11_sleep_params(priv, resp); |
649 | break; | |
6b63cd0f | 650 | case CMD_RET(CMD_802_11_INACTIVITY_TIMEOUT): |
876c9d3a MT |
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); | |
655 | break; | |
656 | ||
6b63cd0f | 657 | case CMD_RET(CMD_802_11_TPC_CFG): |
876c9d3a | 658 | spin_lock_irqsave(&adapter->driver_lock, flags); |
981f187b | 659 | memmove(adapter->cur_cmd->pdata_buf, &resp->params.tpccfg, |
876c9d3a MT |
660 | sizeof(struct cmd_ds_802_11_tpc_cfg)); |
661 | spin_unlock_irqrestore(&adapter->driver_lock, flags); | |
662 | break; | |
6b63cd0f | 663 | case CMD_RET(CMD_802_11_LED_GPIO_CTRL): |
876c9d3a | 664 | spin_lock_irqsave(&adapter->driver_lock, flags); |
981f187b | 665 | memmove(adapter->cur_cmd->pdata_buf, &resp->params.ledgpio, |
876c9d3a MT |
666 | sizeof(struct cmd_ds_802_11_led_ctrl)); |
667 | spin_unlock_irqrestore(&adapter->driver_lock, flags); | |
668 | break; | |
6b63cd0f | 669 | case CMD_RET(CMD_802_11_PWR_CFG): |
876c9d3a | 670 | spin_lock_irqsave(&adapter->driver_lock, flags); |
981f187b | 671 | memmove(adapter->cur_cmd->pdata_buf, &resp->params.pwrcfg, |
876c9d3a MT |
672 | sizeof(struct cmd_ds_802_11_pwr_cfg)); |
673 | spin_unlock_irqrestore(&adapter->driver_lock, flags); | |
674 | ||
675 | break; | |
676 | ||
6b63cd0f | 677 | case CMD_RET(CMD_GET_TSF): |
876c9d3a MT |
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); | |
682 | break; | |
6b63cd0f | 683 | case CMD_RET(CMD_BT_ACCESS): |
876c9d3a MT |
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); | |
689 | break; | |
6b63cd0f | 690 | case CMD_RET(CMD_FWT_ACCESS): |
876c9d3a MT |
691 | spin_lock_irqsave(&adapter->driver_lock, flags); |
692 | if (adapter->cur_cmd->pdata_buf) | |
981f187b DW |
693 | memcpy(adapter->cur_cmd->pdata_buf, &resp->params.fwt, |
694 | sizeof(resp->params.fwt)); | |
876c9d3a MT |
695 | spin_unlock_irqrestore(&adapter->driver_lock, flags); |
696 | break; | |
6b63cd0f | 697 | case CMD_RET(CMD_MESH_ACCESS): |
876c9d3a | 698 | if (adapter->cur_cmd->pdata_buf) |
981f187b | 699 | memcpy(adapter->cur_cmd->pdata_buf, &resp->params.mesh, |
876c9d3a MT |
700 | sizeof(resp->params.mesh)); |
701 | break; | |
876c9d3a | 702 | default: |
a6c8700f | 703 | lbs_deb_host("CMD_RESP: unknown cmd response 0x%04x\n", |
981f187b | 704 | resp->command); |
876c9d3a MT |
705 | break; |
706 | } | |
a6c8700f | 707 | lbs_deb_leave(LBS_DEB_HOST); |
876c9d3a MT |
708 | return ret; |
709 | } | |
710 | ||
711 | int libertas_process_rx_command(wlan_private * priv) | |
712 | { | |
713 | u16 respcmd; | |
714 | struct cmd_ds_command *resp; | |
715 | wlan_adapter *adapter = priv->adapter; | |
716 | int ret = 0; | |
717 | ulong flags; | |
718 | u16 result; | |
719 | ||
a6c8700f | 720 | lbs_deb_enter(LBS_DEB_HOST); |
876c9d3a MT |
721 | |
722 | /* Now we got response from FW, cancel the command timer */ | |
723 | del_timer(&adapter->command_timer); | |
724 | ||
725 | mutex_lock(&adapter->lock); | |
726 | spin_lock_irqsave(&adapter->driver_lock, flags); | |
727 | ||
728 | if (!adapter->cur_cmd) { | |
a6c8700f | 729 | lbs_deb_host("CMD_RESP: cur_cmd is NULL\n"); |
876c9d3a MT |
730 | ret = -1; |
731 | spin_unlock_irqrestore(&adapter->driver_lock, flags); | |
732 | goto done; | |
733 | } | |
734 | resp = (struct cmd_ds_command *)(adapter->cur_cmd->bufvirtualaddr); | |
735 | ||
876c9d3a | 736 | respcmd = le16_to_cpu(resp->command); |
876c9d3a MT |
737 | result = le16_to_cpu(resp->result); |
738 | ||
a6c8700f HS |
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, | |
742 | priv->upld_len); | |
876c9d3a MT |
743 | |
744 | if (!(respcmd & 0x8000)) { | |
a6c8700f | 745 | lbs_deb_host("invalid response!\n"); |
876c9d3a MT |
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); | |
751 | ret = -1; | |
752 | goto done; | |
753 | } | |
754 | ||
755 | /* Store the response code to cur_cmd_retcode. */ | |
981f187b | 756 | adapter->cur_cmd_retcode = result;; |
876c9d3a | 757 | |
6b63cd0f | 758 | if (respcmd == CMD_RET(CMD_802_11_PS_MODE)) { |
981f187b DW |
759 | struct cmd_ds_802_11_ps_mode *psmode = &resp->params.psmode; |
760 | u16 action = le16_to_cpu(psmode->action); | |
876c9d3a | 761 | |
a6c8700f HS |
762 | lbs_deb_host( |
763 | "CMD_RESP: PS_MODE cmd reply result 0x%x, action 0x%x\n", | |
981f187b | 764 | result, action); |
876c9d3a MT |
765 | |
766 | if (result) { | |
a6c8700f | 767 | lbs_deb_host("CMD_RESP: PS command failed with 0x%x\n", |
981f187b DW |
768 | result); |
769 | /* | |
770 | * We should not re-try enter-ps command in | |
771 | * ad-hoc mode. It takes place in | |
772 | * libertas_execute_next_command(). | |
773 | */ | |
774 | if (adapter->mode == IW_MODE_ADHOC && | |
0aef64d7 DW |
775 | action == CMD_SUBCMD_ENTER_PS) |
776 | adapter->psmode = WLAN802_11POWERMODECAM; | |
777 | } else if (action == CMD_SUBCMD_ENTER_PS) { | |
876c9d3a MT |
778 | adapter->needtowakeup = 0; |
779 | adapter->psstate = PS_STATE_AWAKE; | |
780 | ||
a6c8700f | 781 | lbs_deb_host("CMD_RESP: ENTER_PS command response\n"); |
0aef64d7 | 782 | if (adapter->connect_status != LIBERTAS_CONNECTED) { |
876c9d3a MT |
783 | /* |
784 | * When Deauth Event received before Enter_PS command | |
785 | * response, We need to wake up the firmware. | |
786 | */ | |
a6c8700f HS |
787 | lbs_deb_host( |
788 | "disconnected, invoking libertas_ps_wakeup\n"); | |
876c9d3a | 789 | |
876c9d3a | 790 | spin_unlock_irqrestore(&adapter->driver_lock, flags); |
6cfb0082 | 791 | mutex_unlock(&adapter->lock); |
876c9d3a MT |
792 | libertas_ps_wakeup(priv, 0); |
793 | mutex_lock(&adapter->lock); | |
794 | spin_lock_irqsave(&adapter->driver_lock, flags); | |
795 | } | |
0aef64d7 | 796 | } else if (action == CMD_SUBCMD_EXIT_PS) { |
876c9d3a MT |
797 | adapter->needtowakeup = 0; |
798 | adapter->psstate = PS_STATE_FULL_POWER; | |
a6c8700f | 799 | lbs_deb_host("CMD_RESP: EXIT_PS command response\n"); |
876c9d3a | 800 | } else { |
a6c8700f | 801 | lbs_deb_host("CMD_RESP: PS action 0x%X\n", action); |
876c9d3a MT |
802 | } |
803 | ||
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); | |
808 | ||
809 | ret = 0; | |
810 | goto done; | |
811 | } | |
812 | ||
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); | |
816 | ||
817 | adapter->cur_cmd->cmdflags &= ~CMD_F_HOSTCMD; | |
818 | } | |
819 | ||
820 | /* If the command is not successful, cleanup and return failure */ | |
821 | if ((result != 0 || !(respcmd & 0x8000))) { | |
a6c8700f HS |
822 | lbs_deb_host("CMD_RESP: error 0x%04x in command reply 0x%04x\n", |
823 | result, respcmd); | |
876c9d3a MT |
824 | /* |
825 | * Handling errors here | |
826 | */ | |
827 | switch (respcmd) { | |
6b63cd0f HS |
828 | case CMD_RET(CMD_GET_HW_SPEC): |
829 | case CMD_RET(CMD_802_11_RESET): | |
a6c8700f | 830 | lbs_deb_host("CMD_RESP: reset failed\n"); |
876c9d3a MT |
831 | break; |
832 | ||
833 | } | |
834 | ||
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); | |
839 | ||
840 | ret = -1; | |
841 | goto done; | |
842 | } | |
843 | ||
844 | spin_unlock_irqrestore(&adapter->driver_lock, flags); | |
845 | ||
846 | ret = handle_cmd_response(respcmd, resp, priv); | |
847 | ||
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; | |
855 | } | |
856 | spin_unlock_irqrestore(&adapter->driver_lock, flags); | |
857 | ||
858 | done: | |
859 | mutex_unlock(&adapter->lock); | |
a6c8700f | 860 | lbs_deb_leave_args(LBS_DEB_HOST, "ret %d", ret); |
876c9d3a MT |
861 | return ret; |
862 | } | |
863 | ||
864 | int libertas_process_event(wlan_private * priv) | |
865 | { | |
866 | int ret = 0; | |
867 | wlan_adapter *adapter = priv->adapter; | |
868 | u32 eventcause; | |
869 | ||
870 | spin_lock_irq(&adapter->driver_lock); | |
871 | eventcause = adapter->eventcause; | |
872 | spin_unlock_irq(&adapter->driver_lock); | |
873 | ||
9012b28a | 874 | lbs_deb_enter(LBS_DEB_CMD); |
876c9d3a | 875 | |
a6c8700f | 876 | lbs_deb_cmd("event cause 0x%x\n", eventcause); |
876c9d3a MT |
877 | |
878 | switch (eventcause >> SBI_EVENT_CAUSE_SHIFT) { | |
879 | case MACREG_INT_CODE_LINK_SENSED: | |
9012b28a | 880 | lbs_deb_cmd("EVENT: MACREG_INT_CODE_LINK_SENSED\n"); |
876c9d3a MT |
881 | break; |
882 | ||
883 | case MACREG_INT_CODE_DEAUTHENTICATED: | |
a6c8700f | 884 | lbs_deb_cmd("EVENT: deauthenticated\n"); |
876c9d3a MT |
885 | libertas_mac_event_disconnected(priv); |
886 | break; | |
887 | ||
888 | case MACREG_INT_CODE_DISASSOCIATED: | |
a6c8700f | 889 | lbs_deb_cmd("EVENT: disassociated\n"); |
876c9d3a MT |
890 | libertas_mac_event_disconnected(priv); |
891 | break; | |
892 | ||
893 | case MACREG_INT_CODE_LINK_LOSE_NO_SCAN: | |
a6c8700f | 894 | lbs_deb_cmd("EVENT: link lost\n"); |
876c9d3a MT |
895 | libertas_mac_event_disconnected(priv); |
896 | break; | |
897 | ||
898 | case MACREG_INT_CODE_PS_SLEEP: | |
a6c8700f | 899 | lbs_deb_cmd("EVENT: sleep\n"); |
876c9d3a MT |
900 | |
901 | /* handle unexpected PS SLEEP event */ | |
902 | if (adapter->psstate == PS_STATE_FULL_POWER) { | |
9012b28a | 903 | lbs_deb_cmd( |
a6c8700f | 904 | "EVENT: in FULL POWER mode, ignoreing PS_SLEEP\n"); |
876c9d3a MT |
905 | break; |
906 | } | |
907 | adapter->psstate = PS_STATE_PRE_SLEEP; | |
908 | ||
909 | libertas_ps_confirm_sleep(priv, (u16) adapter->psmode); | |
910 | ||
911 | break; | |
912 | ||
913 | case MACREG_INT_CODE_PS_AWAKE: | |
a6c8700f | 914 | lbs_deb_cmd("EVENT: awake\n"); |
876c9d3a MT |
915 | |
916 | /* handle unexpected PS AWAKE event */ | |
917 | if (adapter->psstate == PS_STATE_FULL_POWER) { | |
9012b28a | 918 | lbs_deb_cmd( |
876c9d3a MT |
919 | "EVENT: In FULL POWER mode - ignore PS AWAKE\n"); |
920 | break; | |
921 | } | |
922 | ||
923 | adapter->psstate = PS_STATE_AWAKE; | |
924 | ||
925 | if (adapter->needtowakeup) { | |
926 | /* | |
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() | |
931 | */ | |
a6c8700f | 932 | lbs_deb_cmd("waking up ...\n"); |
876c9d3a MT |
933 | libertas_ps_wakeup(priv, 0); |
934 | } | |
935 | break; | |
936 | ||
937 | case MACREG_INT_CODE_MIC_ERR_UNICAST: | |
9012b28a | 938 | lbs_deb_cmd("EVENT: UNICAST MIC ERROR\n"); |
876c9d3a MT |
939 | handle_mic_failureevent(priv, MACREG_INT_CODE_MIC_ERR_UNICAST); |
940 | break; | |
941 | ||
942 | case MACREG_INT_CODE_MIC_ERR_MULTICAST: | |
9012b28a | 943 | lbs_deb_cmd("EVENT: MULTICAST MIC ERROR\n"); |
876c9d3a MT |
944 | handle_mic_failureevent(priv, MACREG_INT_CODE_MIC_ERR_MULTICAST); |
945 | break; | |
946 | case MACREG_INT_CODE_MIB_CHANGED: | |
947 | case MACREG_INT_CODE_INIT_DONE: | |
948 | break; | |
949 | ||
950 | case MACREG_INT_CODE_ADHOC_BCN_LOST: | |
a6c8700f | 951 | lbs_deb_cmd("EVENT: ADHOC beacon lost\n"); |
876c9d3a MT |
952 | break; |
953 | ||
954 | case MACREG_INT_CODE_RSSI_LOW: | |
a6c8700f | 955 | lbs_pr_alert("EVENT: rssi low\n"); |
876c9d3a MT |
956 | break; |
957 | case MACREG_INT_CODE_SNR_LOW: | |
a6c8700f | 958 | lbs_pr_alert("EVENT: snr low\n"); |
876c9d3a MT |
959 | break; |
960 | case MACREG_INT_CODE_MAX_FAIL: | |
a6c8700f | 961 | lbs_pr_alert("EVENT: max fail\n"); |
876c9d3a MT |
962 | break; |
963 | case MACREG_INT_CODE_RSSI_HIGH: | |
a6c8700f | 964 | lbs_pr_alert("EVENT: rssi high\n"); |
876c9d3a MT |
965 | break; |
966 | case MACREG_INT_CODE_SNR_HIGH: | |
a6c8700f | 967 | lbs_pr_alert("EVENT: snr high\n"); |
876c9d3a MT |
968 | break; |
969 | ||
7d8d28b3 | 970 | case MACREG_INT_CODE_MESH_AUTO_STARTED: |
9cdc6d29 LCC |
971 | lbs_pr_info("EVENT: MESH_AUTO_STARTED\n"); |
972 | adapter->connect_status = LIBERTAS_CONNECTED; | |
7d8d28b3 | 973 | if (priv->mesh_open == 1) { |
9cdc6d29 LCC |
974 | netif_wake_queue(priv->mesh_dev); |
975 | netif_carrier_on(priv->mesh_dev); | |
7d8d28b3 | 976 | } |
9cdc6d29 | 977 | adapter->mode = IW_MODE_ADHOC; |
b8bedefd | 978 | schedule_work(&priv->sync_channel); |
7d8d28b3 LCCR |
979 | break; |
980 | ||
876c9d3a | 981 | default: |
a6c8700f | 982 | lbs_pr_alert("EVENT: unknown event id 0x%04x\n", |
876c9d3a MT |
983 | eventcause >> SBI_EVENT_CAUSE_SHIFT); |
984 | break; | |
985 | } | |
986 | ||
987 | spin_lock_irq(&adapter->driver_lock); | |
988 | adapter->eventcause = 0; | |
989 | spin_unlock_irq(&adapter->driver_lock); | |
9012b28a HS |
990 | |
991 | lbs_deb_enter_args(LBS_DEB_CMD, "ret %d", ret); | |
876c9d3a MT |
992 | return ret; |
993 | } |