]>
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 | ||
31 | if (adapter->connect_status != libertas_connected) | |
32 | return; | |
33 | ||
9012b28a | 34 | lbs_deb_cmd("Handles disconnect event.\n"); |
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; | |
63 | adapter->rxpd_rate = 0; | |
d8efea25 DW |
64 | lbs_deb_cmd("Current SSID='%s', ssid length=%u\n", |
65 | escape_essid(adapter->curbssparams.ssid, | |
66 | adapter->curbssparams.ssid_len), | |
67 | adapter->curbssparams.ssid_len); | |
68 | lbs_deb_cmd("Previous SSID='%s', ssid length=%u\n", | |
69 | escape_essid(adapter->prev_ssid, adapter->prev_ssid_len), | |
70 | adapter->prev_ssid_len); | |
876c9d3a | 71 | |
876c9d3a MT |
72 | adapter->connect_status = libertas_disconnected; |
73 | ||
e76850d6 | 74 | /* Save previous SSID and BSSID for possible reassociation */ |
d8efea25 DW |
75 | memcpy(&adapter->prev_ssid, &adapter->curbssparams.ssid, |
76 | IW_ESSID_MAX_SIZE); | |
77 | adapter->prev_ssid_len = adapter->curbssparams.ssid_len; | |
78 | memcpy(adapter->prev_bssid, adapter->curbssparams.bssid, ETH_ALEN); | |
876c9d3a | 79 | |
e76850d6 DW |
80 | /* Clear out associated SSID and BSSID since connection is |
81 | * no longer valid. | |
82 | */ | |
83 | memset(&adapter->curbssparams.bssid, 0, ETH_ALEN); | |
d8efea25 DW |
84 | memset(&adapter->curbssparams.ssid, 0, IW_ESSID_MAX_SIZE); |
85 | adapter->curbssparams.ssid_len = 0; | |
876c9d3a MT |
86 | |
87 | if (adapter->psstate != PS_STATE_FULL_POWER) { | |
88 | /* make firmware to exit PS mode */ | |
9012b28a | 89 | lbs_deb_cmd("Disconnected, so exit PS mode.\n"); |
876c9d3a MT |
90 | libertas_ps_wakeup(priv, 0); |
91 | } | |
92 | } | |
93 | ||
94 | /** | |
95 | * @brief This function handles MIC failure event. | |
96 | * | |
97 | * @param priv A pointer to wlan_private structure | |
98 | * @para event the event id | |
99 | * @return n/a | |
100 | */ | |
101 | static void handle_mic_failureevent(wlan_private * priv, u32 event) | |
102 | { | |
103 | char buf[50]; | |
104 | ||
105 | memset(buf, 0, sizeof(buf)); | |
106 | ||
107 | sprintf(buf, "%s", "MLME-MICHAELMICFAILURE.indication "); | |
108 | ||
109 | if (event == MACREG_INT_CODE_MIC_ERR_UNICAST) { | |
110 | strcat(buf, "unicast "); | |
111 | } else { | |
112 | strcat(buf, "multicast "); | |
113 | } | |
114 | ||
115 | libertas_send_iwevcustom_event(priv, buf); | |
116 | } | |
117 | ||
118 | static int wlan_ret_reg_access(wlan_private * priv, | |
119 | u16 type, struct cmd_ds_command *resp) | |
120 | { | |
9012b28a | 121 | int ret = 0; |
876c9d3a MT |
122 | wlan_adapter *adapter = priv->adapter; |
123 | ||
9012b28a | 124 | lbs_deb_enter(LBS_DEB_CMD); |
876c9d3a MT |
125 | |
126 | switch (type) { | |
127 | case cmd_ret_mac_reg_access: | |
128 | { | |
981f187b | 129 | struct cmd_ds_mac_reg_access *reg = &resp->params.macreg; |
876c9d3a | 130 | |
981f187b DW |
131 | adapter->offsetvalue.offset = (u32)le16_to_cpu(reg->offset); |
132 | adapter->offsetvalue.value = le32_to_cpu(reg->value); | |
876c9d3a MT |
133 | break; |
134 | } | |
135 | ||
136 | case cmd_ret_bbp_reg_access: | |
137 | { | |
981f187b | 138 | struct cmd_ds_bbp_reg_access *reg = &resp->params.bbpreg; |
876c9d3a | 139 | |
981f187b | 140 | adapter->offsetvalue.offset = (u32)le16_to_cpu(reg->offset); |
876c9d3a MT |
141 | adapter->offsetvalue.value = reg->value; |
142 | break; | |
143 | } | |
144 | ||
145 | case cmd_ret_rf_reg_access: | |
146 | { | |
981f187b | 147 | struct cmd_ds_rf_reg_access *reg = &resp->params.rfreg; |
876c9d3a | 148 | |
981f187b | 149 | adapter->offsetvalue.offset = (u32)le16_to_cpu(reg->offset); |
876c9d3a MT |
150 | adapter->offsetvalue.value = reg->value; |
151 | break; | |
152 | } | |
153 | ||
154 | default: | |
9012b28a | 155 | ret = -1; |
876c9d3a MT |
156 | } |
157 | ||
9012b28a HS |
158 | lbs_deb_enter_args(LBS_DEB_CMD, "ret %d", ret); |
159 | return ret; | |
876c9d3a MT |
160 | } |
161 | ||
162 | static int wlan_ret_get_hw_spec(wlan_private * priv, | |
163 | struct cmd_ds_command *resp) | |
164 | { | |
165 | u32 i; | |
166 | struct cmd_ds_get_hw_spec *hwspec = &resp->params.hwspec; | |
167 | wlan_adapter *adapter = priv->adapter; | |
168 | int ret = 0; | |
169 | ||
9012b28a | 170 | lbs_deb_enter(LBS_DEB_CMD); |
876c9d3a MT |
171 | |
172 | adapter->fwcapinfo = le32_to_cpu(hwspec->fwcapinfo); | |
173 | ||
e5b3d472 | 174 | memcpy(adapter->fwreleasenumber, hwspec->fwreleasenumber, 4); |
876c9d3a | 175 | |
e5b3d472 DW |
176 | lbs_deb_cmd("GET_HW_SPEC: FWReleaseVersion- %u.%u.%u.p%u\n", |
177 | adapter->fwreleasenumber[2], adapter->fwreleasenumber[1], | |
178 | adapter->fwreleasenumber[0], adapter->fwreleasenumber[3]); | |
9012b28a | 179 | lbs_deb_cmd("GET_HW_SPEC: Permanent addr- %2x:%2x:%2x:%2x:%2x:%2x\n", |
876c9d3a MT |
180 | hwspec->permanentaddr[0], hwspec->permanentaddr[1], |
181 | hwspec->permanentaddr[2], hwspec->permanentaddr[3], | |
182 | hwspec->permanentaddr[4], hwspec->permanentaddr[5]); | |
9012b28a | 183 | lbs_deb_cmd("GET_HW_SPEC: hwifversion=0x%X version=0x%X\n", |
876c9d3a MT |
184 | hwspec->hwifversion, hwspec->version); |
185 | ||
186 | adapter->regioncode = le16_to_cpu(hwspec->regioncode); | |
187 | ||
188 | for (i = 0; i < MRVDRV_MAX_REGION_CODE; i++) { | |
189 | /* use the region code to search for the index */ | |
190 | if (adapter->regioncode == libertas_region_code_to_index[i]) { | |
191 | adapter->regiontableindex = (u16) i; | |
192 | break; | |
193 | } | |
194 | } | |
195 | ||
196 | /* if it's unidentified region code, use the default (USA) */ | |
197 | if (i >= MRVDRV_MAX_REGION_CODE) { | |
198 | adapter->regioncode = 0x10; | |
199 | adapter->regiontableindex = 0; | |
981f187b | 200 | lbs_pr_info("unidentified region code; using the default (USA)\n"); |
876c9d3a MT |
201 | } |
202 | ||
981f187b DW |
203 | if (adapter->current_addr[0] == 0xff) |
204 | memmove(adapter->current_addr, hwspec->permanentaddr, ETH_ALEN); | |
876c9d3a | 205 | |
634b8f49 | 206 | memcpy(priv->dev->dev_addr, adapter->current_addr, ETH_ALEN); |
78523daa | 207 | if (priv->mesh_dev) |
981f187b | 208 | memcpy(priv->mesh_dev->dev_addr, adapter->current_addr, ETH_ALEN); |
876c9d3a MT |
209 | |
210 | if (libertas_set_regiontable(priv, adapter->regioncode, 0)) { | |
211 | ret = -1; | |
212 | goto done; | |
213 | } | |
214 | ||
215 | if (libertas_set_universaltable(priv, 0)) { | |
216 | ret = -1; | |
217 | goto done; | |
218 | } | |
219 | ||
9012b28a HS |
220 | done: |
221 | lbs_deb_enter_args(LBS_DEB_CMD, "ret %d", ret); | |
876c9d3a MT |
222 | return ret; |
223 | } | |
224 | ||
225 | static int wlan_ret_802_11_sleep_params(wlan_private * priv, | |
226 | struct cmd_ds_command *resp) | |
227 | { | |
228 | struct cmd_ds_802_11_sleep_params *sp = &resp->params.sleep_params; | |
229 | wlan_adapter *adapter = priv->adapter; | |
230 | ||
9012b28a | 231 | lbs_deb_enter(LBS_DEB_CMD); |
876c9d3a | 232 | |
9012b28a | 233 | lbs_deb_cmd("error=%x offset=%x stabletime=%x calcontrol=%x\n" |
981f187b DW |
234 | " extsleepclk=%x\n", le16_to_cpu(sp->error), |
235 | le16_to_cpu(sp->offset), le16_to_cpu(sp->stabletime), | |
236 | sp->calcontrol, sp->externalsleepclk); | |
237 | ||
876c9d3a MT |
238 | adapter->sp.sp_error = le16_to_cpu(sp->error); |
239 | adapter->sp.sp_offset = le16_to_cpu(sp->offset); | |
240 | adapter->sp.sp_stabletime = le16_to_cpu(sp->stabletime); | |
981f187b DW |
241 | adapter->sp.sp_calcontrol = sp->calcontrol; |
242 | adapter->sp.sp_extsleepclk = sp->externalsleepclk; | |
876c9d3a MT |
243 | adapter->sp.sp_reserved = le16_to_cpu(sp->reserved); |
244 | ||
9012b28a | 245 | lbs_deb_enter(LBS_DEB_CMD); |
876c9d3a MT |
246 | return 0; |
247 | } | |
248 | ||
249 | static int wlan_ret_802_11_stat(wlan_private * priv, | |
250 | struct cmd_ds_command *resp) | |
251 | { | |
252 | /* currently adapter->wlan802_11Stat is unused | |
253 | ||
254 | struct cmd_ds_802_11_get_stat *p11Stat = &resp->params.gstat; | |
255 | wlan_adapter *adapter = priv->adapter; | |
256 | ||
257 | // TODO Convert it to Big endian befor copy | |
258 | memcpy(&adapter->wlan802_11Stat, | |
259 | p11Stat, sizeof(struct cmd_ds_802_11_get_stat)); | |
260 | */ | |
261 | return 0; | |
262 | } | |
263 | ||
264 | static int wlan_ret_802_11_snmp_mib(wlan_private * priv, | |
265 | struct cmd_ds_command *resp) | |
266 | { | |
267 | struct cmd_ds_802_11_snmp_mib *smib = &resp->params.smib; | |
268 | u16 oid = le16_to_cpu(smib->oid); | |
269 | u16 querytype = le16_to_cpu(smib->querytype); | |
270 | ||
9012b28a | 271 | lbs_deb_enter(LBS_DEB_CMD); |
876c9d3a | 272 | |
9012b28a | 273 | lbs_deb_cmd("SNMP_RESP: value of the oid = %x, querytype=%x\n", oid, |
876c9d3a | 274 | querytype); |
981f187b | 275 | lbs_deb_cmd("SNMP_RESP: Buf size = %x\n", le16_to_cpu(smib->bufsize)); |
876c9d3a MT |
276 | |
277 | if (querytype == cmd_act_get) { | |
278 | switch (oid) { | |
279 | case fragthresh_i: | |
280 | priv->adapter->fragthsd = | |
981f187b | 281 | le16_to_cpu(*((__le16 *)(smib->value))); |
9012b28a | 282 | lbs_deb_cmd("SNMP_RESP: fragthsd =%u\n", |
981f187b | 283 | priv->adapter->fragthsd); |
876c9d3a MT |
284 | break; |
285 | case rtsthresh_i: | |
286 | priv->adapter->rtsthsd = | |
981f187b | 287 | le16_to_cpu(*((__le16 *)(smib->value))); |
9012b28a | 288 | lbs_deb_cmd("SNMP_RESP: rtsthsd =%u\n", |
981f187b | 289 | priv->adapter->rtsthsd); |
876c9d3a MT |
290 | break; |
291 | case short_retrylim_i: | |
292 | priv->adapter->txretrycount = | |
981f187b | 293 | le16_to_cpu(*((__le16 *)(smib->value))); |
9012b28a | 294 | lbs_deb_cmd("SNMP_RESP: txretrycount =%u\n", |
981f187b | 295 | priv->adapter->rtsthsd); |
876c9d3a MT |
296 | break; |
297 | default: | |
298 | break; | |
299 | } | |
300 | } | |
301 | ||
9012b28a | 302 | lbs_deb_enter(LBS_DEB_CMD); |
876c9d3a MT |
303 | return 0; |
304 | } | |
305 | ||
306 | static int wlan_ret_802_11_key_material(wlan_private * priv, | |
307 | struct cmd_ds_command *resp) | |
308 | { | |
309 | struct cmd_ds_802_11_key_material *pkeymaterial = | |
310 | &resp->params.keymaterial; | |
311 | wlan_adapter *adapter = priv->adapter; | |
312 | u16 action = le16_to_cpu(pkeymaterial->action); | |
313 | ||
9012b28a | 314 | lbs_deb_enter(LBS_DEB_CMD); |
876c9d3a MT |
315 | |
316 | /* Copy the returned key to driver private data */ | |
317 | if (action == cmd_act_get) { | |
318 | u8 * buf_ptr = (u8 *) &pkeymaterial->keyParamSet; | |
319 | u8 * resp_end = (u8 *) (resp + le16_to_cpu(resp->size)); | |
320 | ||
321 | while (buf_ptr < resp_end) { | |
322 | struct MrvlIEtype_keyParamSet * pkeyparamset = | |
323 | (struct MrvlIEtype_keyParamSet *) buf_ptr; | |
1443b653 | 324 | struct enc_key * pkey; |
876c9d3a | 325 | u16 param_set_len = le16_to_cpu(pkeyparamset->length); |
876c9d3a | 326 | u16 key_len = le16_to_cpu(pkeyparamset->keylen); |
1443b653 DW |
327 | u16 key_flags = le16_to_cpu(pkeyparamset->keyinfo); |
328 | u16 key_type = le16_to_cpu(pkeyparamset->keytypeid); | |
329 | u8 * end; | |
876c9d3a MT |
330 | |
331 | end = (u8 *) pkeyparamset + sizeof (pkeyparamset->type) | |
332 | + sizeof (pkeyparamset->length) | |
333 | + param_set_len; | |
334 | /* Make sure we don't access past the end of the IEs */ | |
335 | if (end > resp_end) | |
336 | break; | |
337 | ||
1443b653 | 338 | if (key_flags & KEY_INFO_WPA_UNICAST) |
876c9d3a | 339 | pkey = &adapter->wpa_unicast_key; |
1443b653 | 340 | else if (key_flags & KEY_INFO_WPA_MCAST) |
876c9d3a MT |
341 | pkey = &adapter->wpa_mcast_key; |
342 | else | |
343 | break; | |
344 | ||
345 | /* Copy returned key into driver */ | |
1443b653 | 346 | memset(pkey, 0, sizeof(struct enc_key)); |
876c9d3a MT |
347 | if (key_len > sizeof(pkey->key)) |
348 | break; | |
1443b653 DW |
349 | pkey->type = key_type; |
350 | pkey->flags = key_flags; | |
351 | pkey->len = key_len; | |
876c9d3a MT |
352 | memcpy(pkey->key, pkeyparamset->key, pkey->len); |
353 | ||
354 | buf_ptr = end + 1; | |
355 | } | |
356 | } | |
357 | ||
9012b28a | 358 | lbs_deb_enter(LBS_DEB_CMD); |
876c9d3a MT |
359 | return 0; |
360 | } | |
361 | ||
362 | static int wlan_ret_802_11_mac_address(wlan_private * priv, | |
363 | struct cmd_ds_command *resp) | |
364 | { | |
365 | struct cmd_ds_802_11_mac_address *macadd = &resp->params.macadd; | |
366 | wlan_adapter *adapter = priv->adapter; | |
367 | ||
9012b28a | 368 | lbs_deb_enter(LBS_DEB_CMD); |
876c9d3a MT |
369 | |
370 | memcpy(adapter->current_addr, macadd->macadd, ETH_ALEN); | |
371 | ||
9012b28a | 372 | lbs_deb_enter(LBS_DEB_CMD); |
876c9d3a MT |
373 | return 0; |
374 | } | |
375 | ||
376 | static int wlan_ret_802_11_rf_tx_power(wlan_private * priv, | |
377 | struct cmd_ds_command *resp) | |
378 | { | |
379 | struct cmd_ds_802_11_rf_tx_power *rtp = &resp->params.txp; | |
380 | wlan_adapter *adapter = priv->adapter; | |
381 | ||
9012b28a | 382 | lbs_deb_enter(LBS_DEB_CMD); |
876c9d3a MT |
383 | |
384 | adapter->txpowerlevel = le16_to_cpu(rtp->currentlevel); | |
385 | ||
9012b28a | 386 | lbs_deb_cmd("Current TxPower Level = %d\n", adapter->txpowerlevel); |
876c9d3a | 387 | |
9012b28a | 388 | lbs_deb_enter(LBS_DEB_CMD); |
876c9d3a MT |
389 | return 0; |
390 | } | |
391 | ||
392 | static int wlan_ret_802_11_rf_antenna(wlan_private * priv, | |
393 | struct cmd_ds_command *resp) | |
394 | { | |
395 | struct cmd_ds_802_11_rf_antenna *pAntenna = &resp->params.rant; | |
396 | wlan_adapter *adapter = priv->adapter; | |
397 | u16 action = le16_to_cpu(pAntenna->action); | |
398 | ||
399 | if (action == cmd_act_get_rx) | |
981f187b | 400 | adapter->rxantennamode = le16_to_cpu(pAntenna->antennamode); |
876c9d3a MT |
401 | |
402 | if (action == cmd_act_get_tx) | |
981f187b | 403 | adapter->txantennamode = le16_to_cpu(pAntenna->antennamode); |
876c9d3a | 404 | |
9012b28a | 405 | lbs_deb_cmd("RF_ANT_RESP: action = 0x%x, mode = 0x%04x\n", |
876c9d3a MT |
406 | action, le16_to_cpu(pAntenna->antennamode)); |
407 | ||
408 | return 0; | |
409 | } | |
410 | ||
411 | static int wlan_ret_802_11_rate_adapt_rateset(wlan_private * priv, | |
412 | struct cmd_ds_command *resp) | |
413 | { | |
981f187b | 414 | struct cmd_ds_802_11_rate_adapt_rateset *rates = &resp->params.rateset; |
876c9d3a MT |
415 | wlan_adapter *adapter = priv->adapter; |
416 | ||
9012b28a | 417 | lbs_deb_enter(LBS_DEB_CMD); |
876c9d3a MT |
418 | |
419 | if (rates->action == cmd_act_get) { | |
981f187b DW |
420 | adapter->enablehwauto = le16_to_cpu(rates->enablehwauto); |
421 | adapter->ratebitmap = le16_to_cpu(rates->bitmap); | |
876c9d3a MT |
422 | } |
423 | ||
9012b28a | 424 | lbs_deb_enter(LBS_DEB_CMD); |
876c9d3a MT |
425 | return 0; |
426 | } | |
427 | ||
428 | static int wlan_ret_802_11_data_rate(wlan_private * priv, | |
429 | struct cmd_ds_command *resp) | |
430 | { | |
431 | struct cmd_ds_802_11_data_rate *pdatarate = &resp->params.drate; | |
432 | wlan_adapter *adapter = priv->adapter; | |
433 | u8 dot11datarate; | |
434 | ||
9012b28a | 435 | lbs_deb_enter(LBS_DEB_CMD); |
876c9d3a MT |
436 | |
437 | lbs_dbg_hex("DATA_RATE_RESP: data_rate- ", | |
438 | (u8 *) pdatarate, sizeof(struct cmd_ds_802_11_data_rate)); | |
439 | ||
440 | dot11datarate = pdatarate->datarate[0]; | |
981f187b | 441 | if (pdatarate->action == cpu_to_le16(cmd_act_get_tx_rate)) { |
876c9d3a MT |
442 | memcpy(adapter->libertas_supported_rates, pdatarate->datarate, |
443 | sizeof(adapter->libertas_supported_rates)); | |
444 | } | |
445 | adapter->datarate = libertas_index_to_data_rate(dot11datarate); | |
446 | ||
9012b28a | 447 | lbs_deb_enter(LBS_DEB_CMD); |
876c9d3a MT |
448 | return 0; |
449 | } | |
450 | ||
451 | static int wlan_ret_802_11_rf_channel(wlan_private * priv, | |
452 | struct cmd_ds_command *resp) | |
453 | { | |
981f187b | 454 | struct cmd_ds_802_11_rf_channel *rfchannel = &resp->params.rfchannel; |
876c9d3a MT |
455 | wlan_adapter *adapter = priv->adapter; |
456 | u16 action = le16_to_cpu(rfchannel->action); | |
457 | u16 newchannel = le16_to_cpu(rfchannel->currentchannel); | |
458 | ||
9012b28a | 459 | lbs_deb_enter(LBS_DEB_CMD); |
876c9d3a MT |
460 | |
461 | if (action == cmd_opt_802_11_rf_channel_get | |
462 | && adapter->curbssparams.channel != newchannel) { | |
9012b28a | 463 | lbs_deb_cmd("channel Switch: %d to %d\n", |
876c9d3a MT |
464 | adapter->curbssparams.channel, newchannel); |
465 | ||
466 | /* Update the channel again */ | |
467 | adapter->curbssparams.channel = newchannel; | |
468 | } | |
469 | ||
9012b28a | 470 | lbs_deb_enter(LBS_DEB_CMD); |
876c9d3a MT |
471 | return 0; |
472 | } | |
473 | ||
474 | static int wlan_ret_802_11_rssi(wlan_private * priv, | |
475 | struct cmd_ds_command *resp) | |
476 | { | |
477 | struct cmd_ds_802_11_rssi_rsp *rssirsp = &resp->params.rssirsp; | |
478 | wlan_adapter *adapter = priv->adapter; | |
479 | ||
480 | /* store the non average value */ | |
481 | adapter->SNR[TYPE_BEACON][TYPE_NOAVG] = le16_to_cpu(rssirsp->SNR); | |
981f187b | 482 | adapter->NF[TYPE_BEACON][TYPE_NOAVG] = le16_to_cpu(rssirsp->noisefloor); |
876c9d3a MT |
483 | |
484 | adapter->SNR[TYPE_BEACON][TYPE_AVG] = le16_to_cpu(rssirsp->avgSNR); | |
981f187b | 485 | adapter->NF[TYPE_BEACON][TYPE_AVG] = le16_to_cpu(rssirsp->avgnoisefloor); |
876c9d3a MT |
486 | |
487 | adapter->RSSI[TYPE_BEACON][TYPE_NOAVG] = | |
488 | CAL_RSSI(adapter->SNR[TYPE_BEACON][TYPE_NOAVG], | |
489 | adapter->NF[TYPE_BEACON][TYPE_NOAVG]); | |
490 | ||
491 | adapter->RSSI[TYPE_BEACON][TYPE_AVG] = | |
492 | CAL_RSSI(adapter->SNR[TYPE_BEACON][TYPE_AVG] / AVG_SCALE, | |
493 | adapter->NF[TYPE_BEACON][TYPE_AVG] / AVG_SCALE); | |
494 | ||
9012b28a | 495 | lbs_deb_cmd("Beacon RSSI value = 0x%x\n", |
876c9d3a MT |
496 | adapter->RSSI[TYPE_BEACON][TYPE_AVG]); |
497 | ||
498 | return 0; | |
499 | } | |
500 | ||
501 | static int wlan_ret_802_11_eeprom_access(wlan_private * priv, | |
502 | struct cmd_ds_command *resp) | |
503 | { | |
504 | wlan_adapter *adapter = priv->adapter; | |
505 | struct wlan_ioctl_regrdwr *pbuf; | |
506 | pbuf = (struct wlan_ioctl_regrdwr *) adapter->prdeeprom; | |
507 | ||
9012b28a | 508 | lbs_deb_cmd("eeprom read len=%x\n", |
876c9d3a MT |
509 | le16_to_cpu(resp->params.rdeeprom.bytecount)); |
510 | if (pbuf->NOB < le16_to_cpu(resp->params.rdeeprom.bytecount)) { | |
511 | pbuf->NOB = 0; | |
9012b28a | 512 | lbs_deb_cmd("eeprom read return length is too big\n"); |
876c9d3a MT |
513 | return -1; |
514 | } | |
515 | pbuf->NOB = le16_to_cpu(resp->params.rdeeprom.bytecount); | |
516 | if (pbuf->NOB > 0) { | |
517 | ||
518 | memcpy(&pbuf->value, (u8 *) & resp->params.rdeeprom.value, | |
519 | le16_to_cpu(resp->params.rdeeprom.bytecount)); | |
520 | lbs_dbg_hex("adapter", (char *)&pbuf->value, | |
521 | le16_to_cpu(resp->params.rdeeprom.bytecount)); | |
522 | } | |
523 | return 0; | |
524 | } | |
525 | ||
526 | static int wlan_ret_get_log(wlan_private * priv, | |
527 | struct cmd_ds_command *resp) | |
528 | { | |
981f187b | 529 | struct cmd_ds_802_11_get_log *logmessage = &resp->params.glog; |
876c9d3a MT |
530 | wlan_adapter *adapter = priv->adapter; |
531 | ||
9012b28a | 532 | lbs_deb_enter(LBS_DEB_CMD); |
876c9d3a | 533 | |
981f187b DW |
534 | /* Stored little-endian */ |
535 | memcpy(&adapter->logmsg, logmessage, sizeof(struct cmd_ds_802_11_get_log)); | |
876c9d3a | 536 | |
9012b28a | 537 | lbs_deb_enter(LBS_DEB_CMD); |
876c9d3a MT |
538 | return 0; |
539 | } | |
540 | ||
18c96c34 DW |
541 | static int libertas_ret_802_11_enable_rsn(wlan_private * priv, |
542 | struct cmd_ds_command *resp) | |
543 | { | |
544 | struct cmd_ds_802_11_enable_rsn *enable_rsn = &resp->params.enbrsn; | |
545 | wlan_adapter *adapter = priv->adapter; | |
546 | u32 * pdata_buf = adapter->cur_cmd->pdata_buf; | |
547 | ||
548 | lbs_deb_enter(LBS_DEB_CMD); | |
549 | ||
550 | if (enable_rsn->action == cpu_to_le16(cmd_act_get)) { | |
551 | if (pdata_buf) | |
552 | *pdata_buf = (u32) le16_to_cpu(enable_rsn->enable); | |
553 | } | |
554 | ||
555 | lbs_deb_enter(LBS_DEB_CMD); | |
556 | return 0; | |
557 | } | |
558 | ||
876c9d3a MT |
559 | static inline int handle_cmd_response(u16 respcmd, |
560 | struct cmd_ds_command *resp, | |
561 | wlan_private *priv) | |
562 | { | |
563 | int ret = 0; | |
564 | unsigned long flags; | |
565 | wlan_adapter *adapter = priv->adapter; | |
566 | ||
567 | switch (respcmd) { | |
568 | case cmd_ret_mac_reg_access: | |
569 | case cmd_ret_bbp_reg_access: | |
570 | case cmd_ret_rf_reg_access: | |
571 | ret = wlan_ret_reg_access(priv, respcmd, resp); | |
572 | break; | |
573 | ||
574 | case cmd_ret_hw_spec_info: | |
575 | ret = wlan_ret_get_hw_spec(priv, resp); | |
576 | break; | |
577 | ||
578 | case cmd_ret_802_11_scan: | |
579 | ret = libertas_ret_80211_scan(priv, resp); | |
580 | break; | |
581 | ||
582 | case cmd_ret_802_11_get_log: | |
583 | ret = wlan_ret_get_log(priv, resp); | |
584 | break; | |
585 | ||
586 | case cmd_ret_802_11_associate: | |
587 | case cmd_ret_802_11_reassociate: | |
588 | ret = libertas_ret_80211_associate(priv, resp); | |
589 | break; | |
590 | ||
591 | case cmd_ret_802_11_disassociate: | |
592 | case cmd_ret_802_11_deauthenticate: | |
593 | ret = libertas_ret_80211_disassociate(priv, resp); | |
594 | break; | |
595 | ||
596 | case cmd_ret_802_11_ad_hoc_start: | |
597 | case cmd_ret_802_11_ad_hoc_join: | |
598 | ret = libertas_ret_80211_ad_hoc_start(priv, resp); | |
599 | break; | |
600 | ||
601 | case cmd_ret_802_11_stat: | |
602 | ret = wlan_ret_802_11_stat(priv, resp); | |
603 | break; | |
604 | ||
605 | case cmd_ret_802_11_snmp_mib: | |
606 | ret = wlan_ret_802_11_snmp_mib(priv, resp); | |
607 | break; | |
608 | ||
609 | case cmd_ret_802_11_rf_tx_power: | |
610 | ret = wlan_ret_802_11_rf_tx_power(priv, resp); | |
611 | break; | |
612 | ||
613 | case cmd_ret_802_11_set_afc: | |
614 | case cmd_ret_802_11_get_afc: | |
615 | spin_lock_irqsave(&adapter->driver_lock, flags); | |
981f187b | 616 | memmove(adapter->cur_cmd->pdata_buf, &resp->params.afc, |
876c9d3a MT |
617 | sizeof(struct cmd_ds_802_11_afc)); |
618 | spin_unlock_irqrestore(&adapter->driver_lock, flags); | |
619 | ||
620 | break; | |
621 | case cmd_ret_802_11_rf_antenna: | |
622 | ret = wlan_ret_802_11_rf_antenna(priv, resp); | |
623 | break; | |
624 | ||
625 | case cmd_ret_mac_multicast_adr: | |
626 | case cmd_ret_mac_control: | |
627 | case cmd_ret_802_11_set_wep: | |
628 | case cmd_ret_802_11_reset: | |
629 | case cmd_ret_802_11_authenticate: | |
630 | case cmd_ret_802_11_radio_control: | |
631 | case cmd_ret_802_11_beacon_stop: | |
18c96c34 DW |
632 | break; |
633 | ||
876c9d3a | 634 | case cmd_ret_802_11_enable_rsn: |
18c96c34 | 635 | ret = libertas_ret_802_11_enable_rsn(priv, resp); |
876c9d3a MT |
636 | break; |
637 | ||
638 | case cmd_ret_802_11_data_rate: | |
639 | ret = wlan_ret_802_11_data_rate(priv, resp); | |
640 | break; | |
641 | case cmd_ret_802_11_rate_adapt_rateset: | |
642 | ret = wlan_ret_802_11_rate_adapt_rateset(priv, resp); | |
643 | break; | |
644 | case cmd_ret_802_11_rf_channel: | |
645 | ret = wlan_ret_802_11_rf_channel(priv, resp); | |
646 | break; | |
647 | ||
648 | case cmd_ret_802_11_rssi: | |
649 | ret = wlan_ret_802_11_rssi(priv, resp); | |
650 | break; | |
651 | ||
652 | case cmd_ret_802_11_mac_address: | |
653 | ret = wlan_ret_802_11_mac_address(priv, resp); | |
654 | break; | |
655 | ||
656 | case cmd_ret_802_11_ad_hoc_stop: | |
657 | ret = libertas_ret_80211_ad_hoc_stop(priv, resp); | |
658 | break; | |
659 | ||
660 | case cmd_ret_802_11_key_material: | |
9012b28a | 661 | lbs_deb_cmd("CMD_RESP: KEY_MATERIAL command response\n"); |
876c9d3a MT |
662 | ret = wlan_ret_802_11_key_material(priv, resp); |
663 | break; | |
664 | ||
665 | case cmd_ret_802_11_eeprom_access: | |
666 | ret = wlan_ret_802_11_eeprom_access(priv, resp); | |
667 | break; | |
668 | ||
669 | case cmd_ret_802_11d_domain_info: | |
670 | ret = libertas_ret_802_11d_domain_info(priv, resp); | |
671 | break; | |
672 | ||
673 | case cmd_ret_802_11_sleep_params: | |
674 | ret = wlan_ret_802_11_sleep_params(priv, resp); | |
675 | break; | |
676 | case cmd_ret_802_11_inactivity_timeout: | |
677 | spin_lock_irqsave(&adapter->driver_lock, flags); | |
678 | *((u16 *) adapter->cur_cmd->pdata_buf) = | |
679 | le16_to_cpu(resp->params.inactivity_timeout.timeout); | |
680 | spin_unlock_irqrestore(&adapter->driver_lock, flags); | |
681 | break; | |
682 | ||
683 | case cmd_ret_802_11_tpc_cfg: | |
684 | spin_lock_irqsave(&adapter->driver_lock, flags); | |
981f187b | 685 | memmove(adapter->cur_cmd->pdata_buf, &resp->params.tpccfg, |
876c9d3a MT |
686 | sizeof(struct cmd_ds_802_11_tpc_cfg)); |
687 | spin_unlock_irqrestore(&adapter->driver_lock, flags); | |
688 | break; | |
689 | case cmd_ret_802_11_led_gpio_ctrl: | |
690 | spin_lock_irqsave(&adapter->driver_lock, flags); | |
981f187b | 691 | memmove(adapter->cur_cmd->pdata_buf, &resp->params.ledgpio, |
876c9d3a MT |
692 | sizeof(struct cmd_ds_802_11_led_ctrl)); |
693 | spin_unlock_irqrestore(&adapter->driver_lock, flags); | |
694 | break; | |
695 | case cmd_ret_802_11_pwr_cfg: | |
696 | spin_lock_irqsave(&adapter->driver_lock, flags); | |
981f187b | 697 | memmove(adapter->cur_cmd->pdata_buf, &resp->params.pwrcfg, |
876c9d3a MT |
698 | sizeof(struct cmd_ds_802_11_pwr_cfg)); |
699 | spin_unlock_irqrestore(&adapter->driver_lock, flags); | |
700 | ||
701 | break; | |
702 | ||
703 | case cmd_ret_get_tsf: | |
704 | spin_lock_irqsave(&adapter->driver_lock, flags); | |
705 | memcpy(priv->adapter->cur_cmd->pdata_buf, | |
706 | &resp->params.gettsf.tsfvalue, sizeof(u64)); | |
707 | spin_unlock_irqrestore(&adapter->driver_lock, flags); | |
708 | break; | |
709 | case cmd_ret_bt_access: | |
710 | spin_lock_irqsave(&adapter->driver_lock, flags); | |
711 | if (adapter->cur_cmd->pdata_buf) | |
712 | memcpy(adapter->cur_cmd->pdata_buf, | |
713 | &resp->params.bt.addr1, 2 * ETH_ALEN); | |
714 | spin_unlock_irqrestore(&adapter->driver_lock, flags); | |
715 | break; | |
716 | case cmd_ret_fwt_access: | |
717 | spin_lock_irqsave(&adapter->driver_lock, flags); | |
718 | if (adapter->cur_cmd->pdata_buf) | |
981f187b DW |
719 | memcpy(adapter->cur_cmd->pdata_buf, &resp->params.fwt, |
720 | sizeof(resp->params.fwt)); | |
876c9d3a MT |
721 | spin_unlock_irqrestore(&adapter->driver_lock, flags); |
722 | break; | |
723 | case cmd_ret_mesh_access: | |
724 | if (adapter->cur_cmd->pdata_buf) | |
981f187b | 725 | memcpy(adapter->cur_cmd->pdata_buf, &resp->params.mesh, |
876c9d3a MT |
726 | sizeof(resp->params.mesh)); |
727 | break; | |
728 | case cmd_rte_802_11_tx_rate_query: | |
729 | priv->adapter->txrate = resp->params.txrate.txrate; | |
730 | break; | |
731 | default: | |
9012b28a | 732 | lbs_deb_cmd("CMD_RESP: Unknown command response %#x\n", |
981f187b | 733 | resp->command); |
876c9d3a MT |
734 | break; |
735 | } | |
736 | return ret; | |
737 | } | |
738 | ||
739 | int libertas_process_rx_command(wlan_private * priv) | |
740 | { | |
741 | u16 respcmd; | |
742 | struct cmd_ds_command *resp; | |
743 | wlan_adapter *adapter = priv->adapter; | |
744 | int ret = 0; | |
745 | ulong flags; | |
746 | u16 result; | |
747 | ||
9012b28a | 748 | lbs_deb_enter(LBS_DEB_CMD); |
876c9d3a | 749 | |
9012b28a | 750 | lbs_deb_cmd("CMD_RESP: @ %lu\n", jiffies); |
876c9d3a MT |
751 | |
752 | /* Now we got response from FW, cancel the command timer */ | |
753 | del_timer(&adapter->command_timer); | |
754 | ||
755 | mutex_lock(&adapter->lock); | |
756 | spin_lock_irqsave(&adapter->driver_lock, flags); | |
757 | ||
758 | if (!adapter->cur_cmd) { | |
9012b28a | 759 | lbs_deb_cmd("CMD_RESP: NULL cur_cmd=%p\n", adapter->cur_cmd); |
876c9d3a MT |
760 | ret = -1; |
761 | spin_unlock_irqrestore(&adapter->driver_lock, flags); | |
762 | goto done; | |
763 | } | |
764 | resp = (struct cmd_ds_command *)(adapter->cur_cmd->bufvirtualaddr); | |
765 | ||
766 | lbs_dbg_hex("CMD_RESP:", adapter->cur_cmd->bufvirtualaddr, | |
981f187b | 767 | priv->upld_len); |
876c9d3a MT |
768 | |
769 | respcmd = le16_to_cpu(resp->command); | |
770 | ||
771 | result = le16_to_cpu(resp->result); | |
772 | ||
9012b28a | 773 | lbs_deb_cmd("CMD_RESP: %x result: %d length: %d\n", respcmd, |
981f187b | 774 | result, priv->upld_len); |
876c9d3a MT |
775 | |
776 | if (!(respcmd & 0x8000)) { | |
9012b28a | 777 | lbs_deb_cmd("Invalid response to command!"); |
876c9d3a MT |
778 | adapter->cur_cmd_retcode = -1; |
779 | __libertas_cleanup_and_insert_cmd(priv, adapter->cur_cmd); | |
780 | adapter->nr_cmd_pending--; | |
781 | adapter->cur_cmd = NULL; | |
782 | spin_unlock_irqrestore(&adapter->driver_lock, flags); | |
783 | ret = -1; | |
784 | goto done; | |
785 | } | |
786 | ||
787 | /* Store the response code to cur_cmd_retcode. */ | |
981f187b | 788 | adapter->cur_cmd_retcode = result;; |
876c9d3a MT |
789 | |
790 | if (respcmd == cmd_ret_802_11_ps_mode) { | |
981f187b DW |
791 | struct cmd_ds_802_11_ps_mode *psmode = &resp->params.psmode; |
792 | u16 action = le16_to_cpu(psmode->action); | |
876c9d3a | 793 | |
9012b28a | 794 | lbs_deb_cmd( |
876c9d3a | 795 | "CMD_RESP: PS_MODE cmd reply result=%#x action=0x%X\n", |
981f187b | 796 | result, action); |
876c9d3a MT |
797 | |
798 | if (result) { | |
9012b28a | 799 | lbs_deb_cmd("CMD_RESP: PS command failed- %#x \n", |
981f187b DW |
800 | result); |
801 | /* | |
802 | * We should not re-try enter-ps command in | |
803 | * ad-hoc mode. It takes place in | |
804 | * libertas_execute_next_command(). | |
805 | */ | |
806 | if (adapter->mode == IW_MODE_ADHOC && | |
807 | action == cmd_subcmd_enter_ps) | |
808 | adapter->psmode = wlan802_11powermodecam; | |
809 | } else if (action == cmd_subcmd_enter_ps) { | |
876c9d3a MT |
810 | adapter->needtowakeup = 0; |
811 | adapter->psstate = PS_STATE_AWAKE; | |
812 | ||
9012b28a | 813 | lbs_deb_cmd("CMD_RESP: Enter_PS command response\n"); |
876c9d3a MT |
814 | if (adapter->connect_status != libertas_connected) { |
815 | /* | |
816 | * When Deauth Event received before Enter_PS command | |
817 | * response, We need to wake up the firmware. | |
818 | */ | |
9012b28a | 819 | lbs_deb_cmd( |
876c9d3a MT |
820 | "Disconnected, Going to invoke libertas_ps_wakeup\n"); |
821 | ||
876c9d3a | 822 | spin_unlock_irqrestore(&adapter->driver_lock, flags); |
6cfb0082 | 823 | mutex_unlock(&adapter->lock); |
876c9d3a MT |
824 | libertas_ps_wakeup(priv, 0); |
825 | mutex_lock(&adapter->lock); | |
826 | spin_lock_irqsave(&adapter->driver_lock, flags); | |
827 | } | |
981f187b | 828 | } else if (action == cmd_subcmd_exit_ps) { |
876c9d3a MT |
829 | adapter->needtowakeup = 0; |
830 | adapter->psstate = PS_STATE_FULL_POWER; | |
9012b28a | 831 | lbs_deb_cmd("CMD_RESP: Exit_PS command response\n"); |
876c9d3a | 832 | } else { |
981f187b | 833 | lbs_deb_cmd("CMD_RESP: PS- action=0x%X\n", action); |
876c9d3a MT |
834 | } |
835 | ||
836 | __libertas_cleanup_and_insert_cmd(priv, adapter->cur_cmd); | |
837 | adapter->nr_cmd_pending--; | |
838 | adapter->cur_cmd = NULL; | |
839 | spin_unlock_irqrestore(&adapter->driver_lock, flags); | |
840 | ||
841 | ret = 0; | |
842 | goto done; | |
843 | } | |
844 | ||
845 | if (adapter->cur_cmd->cmdflags & CMD_F_HOSTCMD) { | |
846 | /* Copy the response back to response buffer */ | |
847 | memcpy(adapter->cur_cmd->pdata_buf, resp, resp->size); | |
848 | ||
849 | adapter->cur_cmd->cmdflags &= ~CMD_F_HOSTCMD; | |
850 | } | |
851 | ||
852 | /* If the command is not successful, cleanup and return failure */ | |
853 | if ((result != 0 || !(respcmd & 0x8000))) { | |
9012b28a | 854 | lbs_deb_cmd("CMD_RESP: command reply %#x result=%#x\n", |
981f187b | 855 | respcmd, result); |
876c9d3a MT |
856 | /* |
857 | * Handling errors here | |
858 | */ | |
859 | switch (respcmd) { | |
860 | case cmd_ret_hw_spec_info: | |
861 | case cmd_ret_802_11_reset: | |
9012b28a | 862 | lbs_deb_cmd("CMD_RESP: Reset command failed\n"); |
876c9d3a MT |
863 | break; |
864 | ||
865 | } | |
866 | ||
867 | __libertas_cleanup_and_insert_cmd(priv, adapter->cur_cmd); | |
868 | adapter->nr_cmd_pending--; | |
869 | adapter->cur_cmd = NULL; | |
870 | spin_unlock_irqrestore(&adapter->driver_lock, flags); | |
871 | ||
872 | ret = -1; | |
873 | goto done; | |
874 | } | |
875 | ||
876 | spin_unlock_irqrestore(&adapter->driver_lock, flags); | |
877 | ||
878 | ret = handle_cmd_response(respcmd, resp, priv); | |
879 | ||
880 | spin_lock_irqsave(&adapter->driver_lock, flags); | |
881 | if (adapter->cur_cmd) { | |
882 | /* Clean up and Put current command back to cmdfreeq */ | |
883 | __libertas_cleanup_and_insert_cmd(priv, adapter->cur_cmd); | |
884 | adapter->nr_cmd_pending--; | |
885 | WARN_ON(adapter->nr_cmd_pending > 128); | |
886 | adapter->cur_cmd = NULL; | |
887 | } | |
888 | spin_unlock_irqrestore(&adapter->driver_lock, flags); | |
889 | ||
890 | done: | |
891 | mutex_unlock(&adapter->lock); | |
9012b28a | 892 | lbs_deb_enter_args(LBS_DEB_CMD, "ret %d", ret); |
876c9d3a MT |
893 | return ret; |
894 | } | |
895 | ||
896 | int libertas_process_event(wlan_private * priv) | |
897 | { | |
898 | int ret = 0; | |
899 | wlan_adapter *adapter = priv->adapter; | |
900 | u32 eventcause; | |
901 | ||
902 | spin_lock_irq(&adapter->driver_lock); | |
903 | eventcause = adapter->eventcause; | |
904 | spin_unlock_irq(&adapter->driver_lock); | |
905 | ||
9012b28a | 906 | lbs_deb_enter(LBS_DEB_CMD); |
876c9d3a | 907 | |
9012b28a | 908 | lbs_deb_cmd("EVENT Cause %x\n", eventcause); |
876c9d3a MT |
909 | |
910 | switch (eventcause >> SBI_EVENT_CAUSE_SHIFT) { | |
911 | case MACREG_INT_CODE_LINK_SENSED: | |
9012b28a | 912 | lbs_deb_cmd("EVENT: MACREG_INT_CODE_LINK_SENSED\n"); |
876c9d3a MT |
913 | break; |
914 | ||
915 | case MACREG_INT_CODE_DEAUTHENTICATED: | |
9012b28a | 916 | lbs_deb_cmd("EVENT: Deauthenticated\n"); |
876c9d3a MT |
917 | libertas_mac_event_disconnected(priv); |
918 | break; | |
919 | ||
920 | case MACREG_INT_CODE_DISASSOCIATED: | |
9012b28a | 921 | lbs_deb_cmd("EVENT: Disassociated\n"); |
876c9d3a MT |
922 | libertas_mac_event_disconnected(priv); |
923 | break; | |
924 | ||
925 | case MACREG_INT_CODE_LINK_LOSE_NO_SCAN: | |
9012b28a | 926 | lbs_deb_cmd("EVENT: Link lost\n"); |
876c9d3a MT |
927 | libertas_mac_event_disconnected(priv); |
928 | break; | |
929 | ||
930 | case MACREG_INT_CODE_PS_SLEEP: | |
9012b28a HS |
931 | lbs_deb_cmd("EVENT: SLEEP\n"); |
932 | lbs_deb_cmd("_"); | |
876c9d3a MT |
933 | |
934 | /* handle unexpected PS SLEEP event */ | |
935 | if (adapter->psstate == PS_STATE_FULL_POWER) { | |
9012b28a | 936 | lbs_deb_cmd( |
876c9d3a MT |
937 | "EVENT: In FULL POWER mode - ignore PS SLEEP\n"); |
938 | break; | |
939 | } | |
940 | adapter->psstate = PS_STATE_PRE_SLEEP; | |
941 | ||
942 | libertas_ps_confirm_sleep(priv, (u16) adapter->psmode); | |
943 | ||
944 | break; | |
945 | ||
946 | case MACREG_INT_CODE_PS_AWAKE: | |
9012b28a HS |
947 | lbs_deb_cmd("EVENT: AWAKE \n"); |
948 | lbs_deb_cmd("|"); | |
876c9d3a MT |
949 | |
950 | /* handle unexpected PS AWAKE event */ | |
951 | if (adapter->psstate == PS_STATE_FULL_POWER) { | |
9012b28a | 952 | lbs_deb_cmd( |
876c9d3a MT |
953 | "EVENT: In FULL POWER mode - ignore PS AWAKE\n"); |
954 | break; | |
955 | } | |
956 | ||
957 | adapter->psstate = PS_STATE_AWAKE; | |
958 | ||
959 | if (adapter->needtowakeup) { | |
960 | /* | |
961 | * wait for the command processing to finish | |
962 | * before resuming sending | |
963 | * adapter->needtowakeup will be set to FALSE | |
964 | * in libertas_ps_wakeup() | |
965 | */ | |
9012b28a | 966 | lbs_deb_cmd("Waking up...\n"); |
876c9d3a MT |
967 | libertas_ps_wakeup(priv, 0); |
968 | } | |
969 | break; | |
970 | ||
971 | case MACREG_INT_CODE_MIC_ERR_UNICAST: | |
9012b28a | 972 | lbs_deb_cmd("EVENT: UNICAST MIC ERROR\n"); |
876c9d3a MT |
973 | handle_mic_failureevent(priv, MACREG_INT_CODE_MIC_ERR_UNICAST); |
974 | break; | |
975 | ||
976 | case MACREG_INT_CODE_MIC_ERR_MULTICAST: | |
9012b28a | 977 | lbs_deb_cmd("EVENT: MULTICAST MIC ERROR\n"); |
876c9d3a MT |
978 | handle_mic_failureevent(priv, MACREG_INT_CODE_MIC_ERR_MULTICAST); |
979 | break; | |
980 | case MACREG_INT_CODE_MIB_CHANGED: | |
981 | case MACREG_INT_CODE_INIT_DONE: | |
982 | break; | |
983 | ||
984 | case MACREG_INT_CODE_ADHOC_BCN_LOST: | |
9012b28a | 985 | lbs_deb_cmd("EVENT: HWAC - ADHOC BCN LOST\n"); |
876c9d3a MT |
986 | break; |
987 | ||
988 | case MACREG_INT_CODE_RSSI_LOW: | |
989 | lbs_pr_alert( "EVENT: RSSI_LOW\n"); | |
990 | break; | |
991 | case MACREG_INT_CODE_SNR_LOW: | |
992 | lbs_pr_alert( "EVENT: SNR_LOW\n"); | |
993 | break; | |
994 | case MACREG_INT_CODE_MAX_FAIL: | |
995 | lbs_pr_alert( "EVENT: MAX_FAIL\n"); | |
996 | break; | |
997 | case MACREG_INT_CODE_RSSI_HIGH: | |
998 | lbs_pr_alert( "EVENT: RSSI_HIGH\n"); | |
999 | break; | |
1000 | case MACREG_INT_CODE_SNR_HIGH: | |
1001 | lbs_pr_alert( "EVENT: SNR_HIGH\n"); | |
1002 | break; | |
1003 | ||
7d8d28b3 LCCR |
1004 | case MACREG_INT_CODE_MESH_AUTO_STARTED: |
1005 | lbs_pr_alert( "EVENT: MESH_AUTO_STARTED\n"); | |
1006 | adapter->connect_status = libertas_connected ; | |
1007 | if (priv->mesh_open == 1) { | |
1008 | netif_wake_queue(priv->mesh_dev) ; | |
1009 | netif_carrier_on(priv->mesh_dev) ; | |
1010 | } | |
1011 | adapter->mode = IW_MODE_ADHOC ; | |
b8bedefd | 1012 | schedule_work(&priv->sync_channel); |
7d8d28b3 LCCR |
1013 | break; |
1014 | ||
876c9d3a MT |
1015 | default: |
1016 | lbs_pr_alert( "EVENT: unknown event id: %#x\n", | |
1017 | eventcause >> SBI_EVENT_CAUSE_SHIFT); | |
1018 | break; | |
1019 | } | |
1020 | ||
1021 | spin_lock_irq(&adapter->driver_lock); | |
1022 | adapter->eventcause = 0; | |
1023 | spin_unlock_irq(&adapter->driver_lock); | |
9012b28a HS |
1024 | |
1025 | lbs_deb_enter_args(LBS_DEB_CMD, "ret %d", ret); | |
876c9d3a MT |
1026 | return ret; |
1027 | } |