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