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