]>
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 | ||
7919b89c | 57 | int lbs_process_command_response(struct lbs_private *priv, u8 *data, u32 len) |
876c9d3a | 58 | { |
e1258177 | 59 | uint16_t respcmd, curcmd; |
ddac4526 | 60 | struct cmd_header *resp; |
876c9d3a | 61 | int ret = 0; |
e1258177 DW |
62 | unsigned long flags; |
63 | uint16_t result; | |
876c9d3a | 64 | |
a6c8700f | 65 | lbs_deb_enter(LBS_DEB_HOST); |
876c9d3a | 66 | |
aa21c004 DW |
67 | mutex_lock(&priv->lock); |
68 | spin_lock_irqsave(&priv->driver_lock, flags); | |
876c9d3a | 69 | |
aa21c004 | 70 | if (!priv->cur_cmd) { |
a6c8700f | 71 | lbs_deb_host("CMD_RESP: cur_cmd is NULL\n"); |
876c9d3a | 72 | ret = -1; |
aa21c004 | 73 | spin_unlock_irqrestore(&priv->driver_lock, flags); |
876c9d3a MT |
74 | goto done; |
75 | } | |
e1258177 | 76 | |
7919b89c | 77 | resp = (void *)data; |
8a96df80 | 78 | curcmd = le16_to_cpu(priv->cur_cmd->cmdbuf->command); |
876c9d3a | 79 | respcmd = le16_to_cpu(resp->command); |
876c9d3a MT |
80 | result = le16_to_cpu(resp->result); |
81 | ||
e5225b39 | 82 | lbs_deb_cmd("CMD_RESP: response 0x%04x, seq %d, size %d\n", |
7919b89c HS |
83 | respcmd, le16_to_cpu(resp->seqnum), len); |
84 | lbs_deb_hex(LBS_DEB_CMD, "CMD_RESP", (void *) resp, len); | |
876c9d3a | 85 | |
6305f498 | 86 | if (resp->seqnum != priv->cur_cmd->cmdbuf->seqnum) { |
e1258177 | 87 | lbs_pr_info("Received CMD_RESP with invalid sequence %d (expected %d)\n", |
6305f498 | 88 | le16_to_cpu(resp->seqnum), le16_to_cpu(priv->cur_cmd->cmdbuf->seqnum)); |
aa21c004 | 89 | spin_unlock_irqrestore(&priv->driver_lock, flags); |
876c9d3a MT |
90 | ret = -1; |
91 | goto done; | |
92 | } | |
e1258177 | 93 | if (respcmd != CMD_RET(curcmd) && |
5f0547c2 | 94 | respcmd != CMD_RET_802_11_ASSOCIATE && curcmd != CMD_802_11_ASSOCIATE) { |
e1258177 DW |
95 | lbs_pr_info("Invalid CMD_RESP %x to command %x!\n", respcmd, curcmd); |
96 | spin_unlock_irqrestore(&priv->driver_lock, flags); | |
97 | ret = -1; | |
98 | goto done; | |
99 | } | |
100 | ||
8538823f DW |
101 | if (resp->result == cpu_to_le16(0x0004)) { |
102 | /* 0x0004 means -EAGAIN. Drop the response, let it time out | |
103 | and be resubmitted */ | |
104 | lbs_pr_info("Firmware returns DEFER to command %x. Will let it time out...\n", | |
105 | le16_to_cpu(resp->command)); | |
106 | spin_unlock_irqrestore(&priv->driver_lock, flags); | |
107 | ret = -1; | |
108 | goto done; | |
109 | } | |
110 | ||
e1258177 DW |
111 | /* Now we got response from FW, cancel the command timer */ |
112 | del_timer(&priv->command_timer); | |
2a345099 | 113 | priv->cmd_timed_out = 0; |
876c9d3a MT |
114 | |
115 | /* Store the response code to cur_cmd_retcode. */ | |
aa21c004 | 116 | priv->cur_cmd_retcode = result; |
876c9d3a | 117 | |
6b63cd0f | 118 | if (respcmd == CMD_RET(CMD_802_11_PS_MODE)) { |
38bfab1a | 119 | struct cmd_ds_802_11_ps_mode *psmode = (void *) &resp[1]; |
981f187b | 120 | u16 action = le16_to_cpu(psmode->action); |
876c9d3a | 121 | |
a6c8700f HS |
122 | lbs_deb_host( |
123 | "CMD_RESP: PS_MODE cmd reply result 0x%x, action 0x%x\n", | |
981f187b | 124 | result, action); |
876c9d3a MT |
125 | |
126 | if (result) { | |
a6c8700f | 127 | lbs_deb_host("CMD_RESP: PS command failed with 0x%x\n", |
981f187b DW |
128 | result); |
129 | /* | |
130 | * We should not re-try enter-ps command in | |
131 | * ad-hoc mode. It takes place in | |
10078321 | 132 | * lbs_execute_next_command(). |
981f187b | 133 | */ |
e86dc1ca | 134 | if (priv->wdev->iftype == NL80211_IFTYPE_MONITOR && |
0aef64d7 | 135 | action == CMD_SUBCMD_ENTER_PS) |
aa21c004 | 136 | priv->psmode = LBS802_11POWERMODECAM; |
0aef64d7 | 137 | } else if (action == CMD_SUBCMD_ENTER_PS) { |
aa21c004 DW |
138 | priv->needtowakeup = 0; |
139 | priv->psstate = PS_STATE_AWAKE; | |
876c9d3a | 140 | |
a6c8700f | 141 | lbs_deb_host("CMD_RESP: ENTER_PS command response\n"); |
aa21c004 | 142 | if (priv->connect_status != LBS_CONNECTED) { |
876c9d3a MT |
143 | /* |
144 | * When Deauth Event received before Enter_PS command | |
145 | * response, We need to wake up the firmware. | |
146 | */ | |
a6c8700f | 147 | lbs_deb_host( |
10078321 | 148 | "disconnected, invoking lbs_ps_wakeup\n"); |
876c9d3a | 149 | |
aa21c004 DW |
150 | spin_unlock_irqrestore(&priv->driver_lock, flags); |
151 | mutex_unlock(&priv->lock); | |
10078321 | 152 | lbs_ps_wakeup(priv, 0); |
aa21c004 DW |
153 | mutex_lock(&priv->lock); |
154 | spin_lock_irqsave(&priv->driver_lock, flags); | |
876c9d3a | 155 | } |
0aef64d7 | 156 | } else if (action == CMD_SUBCMD_EXIT_PS) { |
aa21c004 DW |
157 | priv->needtowakeup = 0; |
158 | priv->psstate = PS_STATE_FULL_POWER; | |
a6c8700f | 159 | lbs_deb_host("CMD_RESP: EXIT_PS command response\n"); |
876c9d3a | 160 | } else { |
a6c8700f | 161 | lbs_deb_host("CMD_RESP: PS action 0x%X\n", action); |
876c9d3a MT |
162 | } |
163 | ||
183aeac1 | 164 | lbs_complete_command(priv, priv->cur_cmd, result); |
aa21c004 | 165 | spin_unlock_irqrestore(&priv->driver_lock, flags); |
876c9d3a MT |
166 | |
167 | ret = 0; | |
168 | goto done; | |
169 | } | |
170 | ||
876c9d3a MT |
171 | /* If the command is not successful, cleanup and return failure */ |
172 | if ((result != 0 || !(respcmd & 0x8000))) { | |
a6c8700f HS |
173 | lbs_deb_host("CMD_RESP: error 0x%04x in command reply 0x%04x\n", |
174 | result, respcmd); | |
876c9d3a MT |
175 | /* |
176 | * Handling errors here | |
177 | */ | |
178 | switch (respcmd) { | |
6b63cd0f HS |
179 | case CMD_RET(CMD_GET_HW_SPEC): |
180 | case CMD_RET(CMD_802_11_RESET): | |
a6c8700f | 181 | lbs_deb_host("CMD_RESP: reset failed\n"); |
876c9d3a MT |
182 | break; |
183 | ||
184 | } | |
183aeac1 | 185 | lbs_complete_command(priv, priv->cur_cmd, result); |
aa21c004 | 186 | spin_unlock_irqrestore(&priv->driver_lock, flags); |
876c9d3a MT |
187 | |
188 | ret = -1; | |
189 | goto done; | |
190 | } | |
191 | ||
aa21c004 | 192 | spin_unlock_irqrestore(&priv->driver_lock, flags); |
1723047d | 193 | |
7ad994de DW |
194 | if (priv->cur_cmd && priv->cur_cmd->callback) { |
195 | ret = priv->cur_cmd->callback(priv, priv->cur_cmd->callback_arg, | |
ddac4526 | 196 | resp); |
81961128 | 197 | } |
1723047d | 198 | |
aa21c004 | 199 | spin_lock_irqsave(&priv->driver_lock, flags); |
1723047d | 200 | |
aa21c004 | 201 | if (priv->cur_cmd) { |
876c9d3a | 202 | /* Clean up and Put current command back to cmdfreeq */ |
183aeac1 | 203 | lbs_complete_command(priv, priv->cur_cmd, result); |
876c9d3a | 204 | } |
aa21c004 | 205 | spin_unlock_irqrestore(&priv->driver_lock, flags); |
876c9d3a MT |
206 | |
207 | done: | |
aa21c004 | 208 | mutex_unlock(&priv->lock); |
a6c8700f | 209 | lbs_deb_leave_args(LBS_DEB_HOST, "ret %d", ret); |
876c9d3a MT |
210 | return ret; |
211 | } | |
212 | ||
7919b89c | 213 | int lbs_process_event(struct lbs_private *priv, u32 event) |
876c9d3a MT |
214 | { |
215 | int ret = 0; | |
66fceb69 | 216 | struct cmd_header cmd; |
876c9d3a | 217 | |
9556d212 HS |
218 | lbs_deb_enter(LBS_DEB_CMD); |
219 | ||
7919b89c | 220 | switch (event) { |
876c9d3a | 221 | case MACREG_INT_CODE_LINK_SENSED: |
d4ff0ef6 | 222 | lbs_deb_cmd("EVENT: link sensed\n"); |
876c9d3a MT |
223 | break; |
224 | ||
225 | case MACREG_INT_CODE_DEAUTHENTICATED: | |
a6c8700f | 226 | lbs_deb_cmd("EVENT: deauthenticated\n"); |
10078321 | 227 | lbs_mac_event_disconnected(priv); |
876c9d3a MT |
228 | break; |
229 | ||
230 | case MACREG_INT_CODE_DISASSOCIATED: | |
a6c8700f | 231 | lbs_deb_cmd("EVENT: disassociated\n"); |
10078321 | 232 | lbs_mac_event_disconnected(priv); |
876c9d3a MT |
233 | break; |
234 | ||
0b3c07ff | 235 | case MACREG_INT_CODE_LINK_LOST_NO_SCAN: |
a6c8700f | 236 | lbs_deb_cmd("EVENT: link lost\n"); |
10078321 | 237 | lbs_mac_event_disconnected(priv); |
876c9d3a MT |
238 | break; |
239 | ||
240 | case MACREG_INT_CODE_PS_SLEEP: | |
d4ff0ef6 | 241 | lbs_deb_cmd("EVENT: ps sleep\n"); |
876c9d3a MT |
242 | |
243 | /* handle unexpected PS SLEEP event */ | |
aa21c004 | 244 | if (priv->psstate == PS_STATE_FULL_POWER) { |
9012b28a | 245 | lbs_deb_cmd( |
a6c8700f | 246 | "EVENT: in FULL POWER mode, ignoreing PS_SLEEP\n"); |
876c9d3a MT |
247 | break; |
248 | } | |
aa21c004 | 249 | priv->psstate = PS_STATE_PRE_SLEEP; |
876c9d3a | 250 | |
d4ff0ef6 | 251 | lbs_ps_confirm_sleep(priv); |
876c9d3a MT |
252 | |
253 | break; | |
254 | ||
b47ef243 | 255 | case MACREG_INT_CODE_HOST_AWAKE: |
d4ff0ef6 | 256 | lbs_deb_cmd("EVENT: host awake\n"); |
49125454 AK |
257 | if (priv->reset_deep_sleep_wakeup) |
258 | priv->reset_deep_sleep_wakeup(priv); | |
259 | priv->is_deep_sleep = 0; | |
66fceb69 AK |
260 | lbs_cmd_async(priv, CMD_802_11_WAKEUP_CONFIRM, &cmd, |
261 | sizeof(cmd)); | |
262 | priv->is_host_sleep_activated = 0; | |
263 | wake_up_interruptible(&priv->host_sleep_q); | |
b47ef243 DW |
264 | break; |
265 | ||
49125454 AK |
266 | case MACREG_INT_CODE_DEEP_SLEEP_AWAKE: |
267 | if (priv->reset_deep_sleep_wakeup) | |
268 | priv->reset_deep_sleep_wakeup(priv); | |
269 | lbs_deb_cmd("EVENT: ds awake\n"); | |
270 | priv->is_deep_sleep = 0; | |
271 | priv->wakeup_dev_required = 0; | |
272 | wake_up_interruptible(&priv->ds_awake_q); | |
273 | break; | |
274 | ||
876c9d3a | 275 | case MACREG_INT_CODE_PS_AWAKE: |
d4ff0ef6 | 276 | lbs_deb_cmd("EVENT: ps awake\n"); |
876c9d3a | 277 | /* handle unexpected PS AWAKE event */ |
aa21c004 | 278 | if (priv->psstate == PS_STATE_FULL_POWER) { |
9012b28a | 279 | lbs_deb_cmd( |
876c9d3a MT |
280 | "EVENT: In FULL POWER mode - ignore PS AWAKE\n"); |
281 | break; | |
282 | } | |
283 | ||
aa21c004 | 284 | priv->psstate = PS_STATE_AWAKE; |
876c9d3a | 285 | |
aa21c004 | 286 | if (priv->needtowakeup) { |
876c9d3a MT |
287 | /* |
288 | * wait for the command processing to finish | |
289 | * before resuming sending | |
aa21c004 | 290 | * priv->needtowakeup will be set to FALSE |
10078321 | 291 | * in lbs_ps_wakeup() |
876c9d3a | 292 | */ |
a6c8700f | 293 | lbs_deb_cmd("waking up ...\n"); |
10078321 | 294 | lbs_ps_wakeup(priv, 0); |
876c9d3a MT |
295 | } |
296 | break; | |
297 | ||
298 | case MACREG_INT_CODE_MIC_ERR_UNICAST: | |
9012b28a | 299 | lbs_deb_cmd("EVENT: UNICAST MIC ERROR\n"); |
560c6338 | 300 | lbs_send_mic_failureevent(priv, event); |
876c9d3a MT |
301 | break; |
302 | ||
303 | case MACREG_INT_CODE_MIC_ERR_MULTICAST: | |
9012b28a | 304 | lbs_deb_cmd("EVENT: MULTICAST MIC ERROR\n"); |
560c6338 | 305 | lbs_send_mic_failureevent(priv, event); |
876c9d3a | 306 | break; |
d4ff0ef6 | 307 | |
876c9d3a | 308 | case MACREG_INT_CODE_MIB_CHANGED: |
d4ff0ef6 HS |
309 | lbs_deb_cmd("EVENT: MIB CHANGED\n"); |
310 | break; | |
876c9d3a | 311 | case MACREG_INT_CODE_INIT_DONE: |
d4ff0ef6 | 312 | lbs_deb_cmd("EVENT: INIT DONE\n"); |
876c9d3a | 313 | break; |
876c9d3a | 314 | case MACREG_INT_CODE_ADHOC_BCN_LOST: |
a6c8700f | 315 | lbs_deb_cmd("EVENT: ADHOC beacon lost\n"); |
876c9d3a | 316 | break; |
876c9d3a | 317 | case MACREG_INT_CODE_RSSI_LOW: |
a6c8700f | 318 | lbs_pr_alert("EVENT: rssi low\n"); |
876c9d3a MT |
319 | break; |
320 | case MACREG_INT_CODE_SNR_LOW: | |
a6c8700f | 321 | lbs_pr_alert("EVENT: snr low\n"); |
876c9d3a MT |
322 | break; |
323 | case MACREG_INT_CODE_MAX_FAIL: | |
a6c8700f | 324 | lbs_pr_alert("EVENT: max fail\n"); |
876c9d3a MT |
325 | break; |
326 | case MACREG_INT_CODE_RSSI_HIGH: | |
a6c8700f | 327 | lbs_pr_alert("EVENT: rssi high\n"); |
876c9d3a MT |
328 | break; |
329 | case MACREG_INT_CODE_SNR_HIGH: | |
a6c8700f | 330 | lbs_pr_alert("EVENT: snr high\n"); |
876c9d3a MT |
331 | break; |
332 | ||
7d8d28b3 | 333 | case MACREG_INT_CODE_MESH_AUTO_STARTED: |
d6ede678 HS |
334 | /* Ignore spurious autostart events */ |
335 | lbs_pr_info("EVENT: MESH_AUTO_STARTED (ignoring)\n"); | |
7d8d28b3 LCCR |
336 | break; |
337 | ||
876c9d3a | 338 | default: |
7919b89c | 339 | lbs_pr_alert("EVENT: unknown event id %d\n", event); |
876c9d3a MT |
340 | break; |
341 | } | |
342 | ||
9556d212 | 343 | lbs_deb_leave_args(LBS_DEB_CMD, "ret %d", ret); |
876c9d3a MT |
344 | return ret; |
345 | } |