Commit | Line | Data |
---|---|---|
876c9d3a MT |
1 | /** |
2 | * This file contains the handling of command | |
3 | * responses as well as events generated by firmware. | |
4 | */ | |
5a0e3ad6 | 5 | #include <linux/slab.h> |
876c9d3a | 6 | #include <linux/delay.h> |
767e366f | 7 | #include <linux/sched.h> |
2c5b9e51 | 8 | #include <asm/unaligned.h> |
e86dc1ca | 9 | #include <net/cfg80211.h> |
876c9d3a | 10 | |
e86dc1ca | 11 | #include "cfg.h" |
66fceb69 | 12 | #include "cmd.h" |
876c9d3a MT |
13 | |
14 | /** | |
15 | * @brief This function handles disconnect event. it | |
16 | * reports disconnect to upper layer, clean tx/rx packets, | |
17 | * reset link state etc. | |
18 | * | |
69f9032d | 19 | * @param priv A pointer to struct lbs_private structure |
876c9d3a MT |
20 | * @return n/a |
21 | */ | |
69f9032d | 22 | void lbs_mac_event_disconnected(struct lbs_private *priv) |
876c9d3a | 23 | { |
aa21c004 | 24 | if (priv->connect_status != LBS_CONNECTED) |
876c9d3a MT |
25 | return; |
26 | ||
91843463 | 27 | lbs_deb_enter(LBS_DEB_ASSOC); |
876c9d3a | 28 | |
876c9d3a MT |
29 | /* |
30 | * Cisco AP sends EAP failure and de-auth in less than 0.5 ms. | |
31 | * It causes problem in the Supplicant | |
32 | */ | |
876c9d3a | 33 | msleep_interruptible(1000); |
e4fe4eaf KD |
34 | |
35 | if (priv->wdev->iftype == NL80211_IFTYPE_STATION) | |
36 | lbs_send_disconnect_notification(priv); | |
876c9d3a | 37 | |
876c9d3a | 38 | /* report disconnect to upper layer */ |
634b8f49 HS |
39 | netif_stop_queue(priv->dev); |
40 | netif_carrier_off(priv->dev); | |
876c9d3a | 41 | |
a27b9f96 DW |
42 | /* Free Tx and Rx packets */ |
43 | kfree_skb(priv->currenttxskb); | |
44 | priv->currenttxskb = NULL; | |
45 | priv->tx_pending_len = 0; | |
46 | ||
aa21c004 | 47 | priv->connect_status = LBS_DISCONNECTED; |
876c9d3a | 48 | |
aa21c004 | 49 | if (priv->psstate != PS_STATE_FULL_POWER) { |
876c9d3a | 50 | /* make firmware to exit PS mode */ |
a6c8700f | 51 | lbs_deb_cmd("disconnected, so exit PS mode\n"); |
10078321 | 52 | lbs_ps_wakeup(priv, 0); |
876c9d3a | 53 | } |
52507c20 | 54 | lbs_deb_leave(LBS_DEB_ASSOC); |
876c9d3a MT |
55 | } |
56 | ||
1309b55b | 57 | static inline int handle_cmd_response(struct lbs_private *priv, |
ddac4526 | 58 | struct cmd_header *cmd_response) |
876c9d3a | 59 | { |
ddac4526 | 60 | struct cmd_ds_command *resp = (struct cmd_ds_command *) cmd_response; |
876c9d3a | 61 | int ret = 0; |
1309b55b | 62 | uint16_t respcmd = le16_to_cpu(resp->command); |
876c9d3a | 63 | |
a6c8700f HS |
64 | lbs_deb_enter(LBS_DEB_HOST); |
65 | ||
876c9d3a | 66 | switch (respcmd) { |
6b63cd0f | 67 | case CMD_RET(CMD_802_11_BEACON_STOP): |
18c96c34 DW |
68 | break; |
69 | ||
876c9d3a | 70 | default: |
e37fc6e1 DW |
71 | lbs_pr_err("CMD_RESP: unknown cmd response 0x%04x\n", |
72 | le16_to_cpu(resp->command)); | |
876c9d3a MT |
73 | break; |
74 | } | |
a6c8700f | 75 | lbs_deb_leave(LBS_DEB_HOST); |
876c9d3a MT |
76 | return ret; |
77 | } | |
78 | ||
7919b89c | 79 | int lbs_process_command_response(struct lbs_private *priv, u8 *data, u32 len) |
876c9d3a | 80 | { |
e1258177 | 81 | uint16_t respcmd, curcmd; |
ddac4526 | 82 | struct cmd_header *resp; |
876c9d3a | 83 | int ret = 0; |
e1258177 DW |
84 | unsigned long flags; |
85 | uint16_t result; | |
876c9d3a | 86 | |
a6c8700f | 87 | lbs_deb_enter(LBS_DEB_HOST); |
876c9d3a | 88 | |
aa21c004 DW |
89 | mutex_lock(&priv->lock); |
90 | spin_lock_irqsave(&priv->driver_lock, flags); | |
876c9d3a | 91 | |
aa21c004 | 92 | if (!priv->cur_cmd) { |
a6c8700f | 93 | lbs_deb_host("CMD_RESP: cur_cmd is NULL\n"); |
876c9d3a | 94 | ret = -1; |
aa21c004 | 95 | spin_unlock_irqrestore(&priv->driver_lock, flags); |
876c9d3a MT |
96 | goto done; |
97 | } | |
e1258177 | 98 | |
7919b89c | 99 | resp = (void *)data; |
8a96df80 | 100 | curcmd = le16_to_cpu(priv->cur_cmd->cmdbuf->command); |
876c9d3a | 101 | respcmd = le16_to_cpu(resp->command); |
876c9d3a MT |
102 | result = le16_to_cpu(resp->result); |
103 | ||
e5225b39 | 104 | lbs_deb_cmd("CMD_RESP: response 0x%04x, seq %d, size %d\n", |
7919b89c HS |
105 | respcmd, le16_to_cpu(resp->seqnum), len); |
106 | lbs_deb_hex(LBS_DEB_CMD, "CMD_RESP", (void *) resp, len); | |
876c9d3a | 107 | |
6305f498 | 108 | if (resp->seqnum != priv->cur_cmd->cmdbuf->seqnum) { |
e1258177 | 109 | lbs_pr_info("Received CMD_RESP with invalid sequence %d (expected %d)\n", |
6305f498 | 110 | le16_to_cpu(resp->seqnum), le16_to_cpu(priv->cur_cmd->cmdbuf->seqnum)); |
aa21c004 | 111 | spin_unlock_irqrestore(&priv->driver_lock, flags); |
876c9d3a MT |
112 | ret = -1; |
113 | goto done; | |
114 | } | |
e1258177 | 115 | if (respcmd != CMD_RET(curcmd) && |
5f0547c2 | 116 | respcmd != CMD_RET_802_11_ASSOCIATE && curcmd != CMD_802_11_ASSOCIATE) { |
e1258177 DW |
117 | lbs_pr_info("Invalid CMD_RESP %x to command %x!\n", respcmd, curcmd); |
118 | spin_unlock_irqrestore(&priv->driver_lock, flags); | |
119 | ret = -1; | |
120 | goto done; | |
121 | } | |
122 | ||
8538823f DW |
123 | if (resp->result == cpu_to_le16(0x0004)) { |
124 | /* 0x0004 means -EAGAIN. Drop the response, let it time out | |
125 | and be resubmitted */ | |
126 | lbs_pr_info("Firmware returns DEFER to command %x. Will let it time out...\n", | |
127 | le16_to_cpu(resp->command)); | |
128 | spin_unlock_irqrestore(&priv->driver_lock, flags); | |
129 | ret = -1; | |
130 | goto done; | |
131 | } | |
132 | ||
e1258177 DW |
133 | /* Now we got response from FW, cancel the command timer */ |
134 | del_timer(&priv->command_timer); | |
2a345099 | 135 | priv->cmd_timed_out = 0; |
876c9d3a MT |
136 | |
137 | /* Store the response code to cur_cmd_retcode. */ | |
aa21c004 | 138 | priv->cur_cmd_retcode = result; |
876c9d3a | 139 | |
6b63cd0f | 140 | if (respcmd == CMD_RET(CMD_802_11_PS_MODE)) { |
38bfab1a | 141 | struct cmd_ds_802_11_ps_mode *psmode = (void *) &resp[1]; |
981f187b | 142 | u16 action = le16_to_cpu(psmode->action); |
876c9d3a | 143 | |
a6c8700f HS |
144 | lbs_deb_host( |
145 | "CMD_RESP: PS_MODE cmd reply result 0x%x, action 0x%x\n", | |
981f187b | 146 | result, action); |
876c9d3a MT |
147 | |
148 | if (result) { | |
a6c8700f | 149 | lbs_deb_host("CMD_RESP: PS command failed with 0x%x\n", |
981f187b DW |
150 | result); |
151 | /* | |
152 | * We should not re-try enter-ps command in | |
153 | * ad-hoc mode. It takes place in | |
10078321 | 154 | * lbs_execute_next_command(). |
981f187b | 155 | */ |
e86dc1ca | 156 | if (priv->wdev->iftype == NL80211_IFTYPE_MONITOR && |
0aef64d7 | 157 | action == CMD_SUBCMD_ENTER_PS) |
aa21c004 | 158 | priv->psmode = LBS802_11POWERMODECAM; |
0aef64d7 | 159 | } else if (action == CMD_SUBCMD_ENTER_PS) { |
aa21c004 DW |
160 | priv->needtowakeup = 0; |
161 | priv->psstate = PS_STATE_AWAKE; | |
876c9d3a | 162 | |
a6c8700f | 163 | lbs_deb_host("CMD_RESP: ENTER_PS command response\n"); |
aa21c004 | 164 | if (priv->connect_status != LBS_CONNECTED) { |
876c9d3a MT |
165 | /* |
166 | * When Deauth Event received before Enter_PS command | |
167 | * response, We need to wake up the firmware. | |
168 | */ | |
a6c8700f | 169 | lbs_deb_host( |
10078321 | 170 | "disconnected, invoking lbs_ps_wakeup\n"); |
876c9d3a | 171 | |
aa21c004 DW |
172 | spin_unlock_irqrestore(&priv->driver_lock, flags); |
173 | mutex_unlock(&priv->lock); | |
10078321 | 174 | lbs_ps_wakeup(priv, 0); |
aa21c004 DW |
175 | mutex_lock(&priv->lock); |
176 | spin_lock_irqsave(&priv->driver_lock, flags); | |
876c9d3a | 177 | } |
0aef64d7 | 178 | } else if (action == CMD_SUBCMD_EXIT_PS) { |
aa21c004 DW |
179 | priv->needtowakeup = 0; |
180 | priv->psstate = PS_STATE_FULL_POWER; | |
a6c8700f | 181 | lbs_deb_host("CMD_RESP: EXIT_PS command response\n"); |
876c9d3a | 182 | } else { |
a6c8700f | 183 | lbs_deb_host("CMD_RESP: PS action 0x%X\n", action); |
876c9d3a MT |
184 | } |
185 | ||
183aeac1 | 186 | lbs_complete_command(priv, priv->cur_cmd, result); |
aa21c004 | 187 | spin_unlock_irqrestore(&priv->driver_lock, flags); |
876c9d3a MT |
188 | |
189 | ret = 0; | |
190 | goto done; | |
191 | } | |
192 | ||
876c9d3a MT |
193 | /* If the command is not successful, cleanup and return failure */ |
194 | if ((result != 0 || !(respcmd & 0x8000))) { | |
a6c8700f HS |
195 | lbs_deb_host("CMD_RESP: error 0x%04x in command reply 0x%04x\n", |
196 | result, respcmd); | |
876c9d3a MT |
197 | /* |
198 | * Handling errors here | |
199 | */ | |
200 | switch (respcmd) { | |
6b63cd0f HS |
201 | case CMD_RET(CMD_GET_HW_SPEC): |
202 | case CMD_RET(CMD_802_11_RESET): | |
a6c8700f | 203 | lbs_deb_host("CMD_RESP: reset failed\n"); |
876c9d3a MT |
204 | break; |
205 | ||
206 | } | |
183aeac1 | 207 | lbs_complete_command(priv, priv->cur_cmd, result); |
aa21c004 | 208 | spin_unlock_irqrestore(&priv->driver_lock, flags); |
876c9d3a MT |
209 | |
210 | ret = -1; | |
211 | goto done; | |
212 | } | |
213 | ||
aa21c004 | 214 | spin_unlock_irqrestore(&priv->driver_lock, flags); |
1723047d | 215 | |
7ad994de DW |
216 | if (priv->cur_cmd && priv->cur_cmd->callback) { |
217 | ret = priv->cur_cmd->callback(priv, priv->cur_cmd->callback_arg, | |
ddac4526 | 218 | resp); |
7ad994de | 219 | } else |
e98a88dd | 220 | ret = handle_cmd_response(priv, resp); |
1723047d | 221 | |
aa21c004 | 222 | spin_lock_irqsave(&priv->driver_lock, flags); |
1723047d | 223 | |
aa21c004 | 224 | if (priv->cur_cmd) { |
876c9d3a | 225 | /* Clean up and Put current command back to cmdfreeq */ |
183aeac1 | 226 | lbs_complete_command(priv, priv->cur_cmd, result); |
876c9d3a | 227 | } |
aa21c004 | 228 | spin_unlock_irqrestore(&priv->driver_lock, flags); |
876c9d3a MT |
229 | |
230 | done: | |
aa21c004 | 231 | mutex_unlock(&priv->lock); |
a6c8700f | 232 | lbs_deb_leave_args(LBS_DEB_HOST, "ret %d", ret); |
876c9d3a MT |
233 | return ret; |
234 | } | |
235 | ||
7919b89c | 236 | int lbs_process_event(struct lbs_private *priv, u32 event) |
876c9d3a MT |
237 | { |
238 | int ret = 0; | |
66fceb69 | 239 | struct cmd_header cmd; |
876c9d3a | 240 | |
9556d212 HS |
241 | lbs_deb_enter(LBS_DEB_CMD); |
242 | ||
7919b89c | 243 | switch (event) { |
876c9d3a | 244 | case MACREG_INT_CODE_LINK_SENSED: |
d4ff0ef6 | 245 | lbs_deb_cmd("EVENT: link sensed\n"); |
876c9d3a MT |
246 | break; |
247 | ||
248 | case MACREG_INT_CODE_DEAUTHENTICATED: | |
a6c8700f | 249 | lbs_deb_cmd("EVENT: deauthenticated\n"); |
10078321 | 250 | lbs_mac_event_disconnected(priv); |
876c9d3a MT |
251 | break; |
252 | ||
253 | case MACREG_INT_CODE_DISASSOCIATED: | |
a6c8700f | 254 | lbs_deb_cmd("EVENT: disassociated\n"); |
10078321 | 255 | lbs_mac_event_disconnected(priv); |
876c9d3a MT |
256 | break; |
257 | ||
0b3c07ff | 258 | case MACREG_INT_CODE_LINK_LOST_NO_SCAN: |
a6c8700f | 259 | lbs_deb_cmd("EVENT: link lost\n"); |
10078321 | 260 | lbs_mac_event_disconnected(priv); |
876c9d3a MT |
261 | break; |
262 | ||
263 | case MACREG_INT_CODE_PS_SLEEP: | |
d4ff0ef6 | 264 | lbs_deb_cmd("EVENT: ps sleep\n"); |
876c9d3a MT |
265 | |
266 | /* handle unexpected PS SLEEP event */ | |
aa21c004 | 267 | if (priv->psstate == PS_STATE_FULL_POWER) { |
9012b28a | 268 | lbs_deb_cmd( |
a6c8700f | 269 | "EVENT: in FULL POWER mode, ignoreing PS_SLEEP\n"); |
876c9d3a MT |
270 | break; |
271 | } | |
aa21c004 | 272 | priv->psstate = PS_STATE_PRE_SLEEP; |
876c9d3a | 273 | |
d4ff0ef6 | 274 | lbs_ps_confirm_sleep(priv); |
876c9d3a MT |
275 | |
276 | break; | |
277 | ||
b47ef243 | 278 | case MACREG_INT_CODE_HOST_AWAKE: |
d4ff0ef6 | 279 | lbs_deb_cmd("EVENT: host awake\n"); |
49125454 AK |
280 | if (priv->reset_deep_sleep_wakeup) |
281 | priv->reset_deep_sleep_wakeup(priv); | |
282 | priv->is_deep_sleep = 0; | |
66fceb69 AK |
283 | lbs_cmd_async(priv, CMD_802_11_WAKEUP_CONFIRM, &cmd, |
284 | sizeof(cmd)); | |
285 | priv->is_host_sleep_activated = 0; | |
286 | wake_up_interruptible(&priv->host_sleep_q); | |
b47ef243 DW |
287 | break; |
288 | ||
49125454 AK |
289 | case MACREG_INT_CODE_DEEP_SLEEP_AWAKE: |
290 | if (priv->reset_deep_sleep_wakeup) | |
291 | priv->reset_deep_sleep_wakeup(priv); | |
292 | lbs_deb_cmd("EVENT: ds awake\n"); | |
293 | priv->is_deep_sleep = 0; | |
294 | priv->wakeup_dev_required = 0; | |
295 | wake_up_interruptible(&priv->ds_awake_q); | |
296 | break; | |
297 | ||
876c9d3a | 298 | case MACREG_INT_CODE_PS_AWAKE: |
d4ff0ef6 | 299 | lbs_deb_cmd("EVENT: ps awake\n"); |
876c9d3a | 300 | /* handle unexpected PS AWAKE event */ |
aa21c004 | 301 | if (priv->psstate == PS_STATE_FULL_POWER) { |
9012b28a | 302 | lbs_deb_cmd( |
876c9d3a MT |
303 | "EVENT: In FULL POWER mode - ignore PS AWAKE\n"); |
304 | break; | |
305 | } | |
306 | ||
aa21c004 | 307 | priv->psstate = PS_STATE_AWAKE; |
876c9d3a | 308 | |
aa21c004 | 309 | if (priv->needtowakeup) { |
876c9d3a MT |
310 | /* |
311 | * wait for the command processing to finish | |
312 | * before resuming sending | |
aa21c004 | 313 | * priv->needtowakeup will be set to FALSE |
10078321 | 314 | * in lbs_ps_wakeup() |
876c9d3a | 315 | */ |
a6c8700f | 316 | lbs_deb_cmd("waking up ...\n"); |
10078321 | 317 | lbs_ps_wakeup(priv, 0); |
876c9d3a MT |
318 | } |
319 | break; | |
320 | ||
321 | case MACREG_INT_CODE_MIC_ERR_UNICAST: | |
9012b28a | 322 | lbs_deb_cmd("EVENT: UNICAST MIC ERROR\n"); |
560c6338 | 323 | lbs_send_mic_failureevent(priv, event); |
876c9d3a MT |
324 | break; |
325 | ||
326 | case MACREG_INT_CODE_MIC_ERR_MULTICAST: | |
9012b28a | 327 | lbs_deb_cmd("EVENT: MULTICAST MIC ERROR\n"); |
560c6338 | 328 | lbs_send_mic_failureevent(priv, event); |
876c9d3a | 329 | break; |
d4ff0ef6 | 330 | |
876c9d3a | 331 | case MACREG_INT_CODE_MIB_CHANGED: |
d4ff0ef6 HS |
332 | lbs_deb_cmd("EVENT: MIB CHANGED\n"); |
333 | break; | |
876c9d3a | 334 | case MACREG_INT_CODE_INIT_DONE: |
d4ff0ef6 | 335 | lbs_deb_cmd("EVENT: INIT DONE\n"); |
876c9d3a | 336 | break; |
876c9d3a | 337 | case MACREG_INT_CODE_ADHOC_BCN_LOST: |
a6c8700f | 338 | lbs_deb_cmd("EVENT: ADHOC beacon lost\n"); |
876c9d3a | 339 | break; |
876c9d3a | 340 | case MACREG_INT_CODE_RSSI_LOW: |
a6c8700f | 341 | lbs_pr_alert("EVENT: rssi low\n"); |
876c9d3a MT |
342 | break; |
343 | case MACREG_INT_CODE_SNR_LOW: | |
a6c8700f | 344 | lbs_pr_alert("EVENT: snr low\n"); |
876c9d3a MT |
345 | break; |
346 | case MACREG_INT_CODE_MAX_FAIL: | |
a6c8700f | 347 | lbs_pr_alert("EVENT: max fail\n"); |
876c9d3a MT |
348 | break; |
349 | case MACREG_INT_CODE_RSSI_HIGH: | |
a6c8700f | 350 | lbs_pr_alert("EVENT: rssi high\n"); |
876c9d3a MT |
351 | break; |
352 | case MACREG_INT_CODE_SNR_HIGH: | |
a6c8700f | 353 | lbs_pr_alert("EVENT: snr high\n"); |
876c9d3a MT |
354 | break; |
355 | ||
7d8d28b3 | 356 | case MACREG_INT_CODE_MESH_AUTO_STARTED: |
d6ede678 HS |
357 | /* Ignore spurious autostart events */ |
358 | lbs_pr_info("EVENT: MESH_AUTO_STARTED (ignoring)\n"); | |
7d8d28b3 LCCR |
359 | break; |
360 | ||
876c9d3a | 361 | default: |
7919b89c | 362 | lbs_pr_alert("EVENT: unknown event id %d\n", event); |
876c9d3a MT |
363 | break; |
364 | } | |
365 | ||
9556d212 | 366 | lbs_deb_leave_args(LBS_DEB_CMD, "ret %d", ret); |
876c9d3a MT |
367 | return ret; |
368 | } |