cmdresp.c 11 KB

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