sta_event.c 30 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020
  1. /*
  2. * Marvell Wireless LAN device driver: station event handling
  3. *
  4. * Copyright (C) 2011-2014, Marvell International Ltd.
  5. *
  6. * This software file (the "File") is distributed by Marvell International
  7. * Ltd. under the terms of the GNU General Public License Version 2, June 1991
  8. * (the "License"). You may use, redistribute and/or modify this File in
  9. * accordance with the terms and conditions of the License, a copy of which
  10. * is available by writing to the Free Software Foundation, Inc.,
  11. * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA or on the
  12. * worldwide web at http://www.gnu.org/licenses/old-licenses/gpl-2.0.txt.
  13. *
  14. * THE FILE IS DISTRIBUTED AS-IS, WITHOUT WARRANTY OF ANY KIND, AND THE
  15. * IMPLIED WARRANTIES OF MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE
  16. * ARE EXPRESSLY DISCLAIMED. The License provides additional details about
  17. * this warranty disclaimer.
  18. */
  19. #include "decl.h"
  20. #include "ioctl.h"
  21. #include "util.h"
  22. #include "fw.h"
  23. #include "main.h"
  24. #include "wmm.h"
  25. #include "11n.h"
  26. #define MWIFIEX_IBSS_CONNECT_EVT_FIX_SIZE 12
  27. static int mwifiex_check_ibss_peer_capabilties(struct mwifiex_private *priv,
  28. struct mwifiex_sta_node *sta_ptr,
  29. struct sk_buff *event)
  30. {
  31. int evt_len, ele_len;
  32. u8 *curr;
  33. struct ieee_types_header *ele_hdr;
  34. struct mwifiex_ie_types_mgmt_frame *tlv_mgmt_frame;
  35. const struct ieee80211_ht_cap *ht_cap;
  36. const struct ieee80211_vht_cap *vht_cap;
  37. skb_pull(event, MWIFIEX_IBSS_CONNECT_EVT_FIX_SIZE);
  38. evt_len = event->len;
  39. curr = event->data;
  40. mwifiex_dbg_dump(priv->adapter, EVT_D, "ibss peer capabilties:",
  41. event->data, event->len);
  42. skb_push(event, MWIFIEX_IBSS_CONNECT_EVT_FIX_SIZE);
  43. tlv_mgmt_frame = (void *)curr;
  44. if (evt_len >= sizeof(*tlv_mgmt_frame) &&
  45. le16_to_cpu(tlv_mgmt_frame->header.type) ==
  46. TLV_TYPE_UAP_MGMT_FRAME) {
  47. /* Locate curr pointer to the start of beacon tlv,
  48. * timestamp 8 bytes, beacon intervel 2 bytes,
  49. * capability info 2 bytes, totally 12 byte beacon header
  50. */
  51. evt_len = le16_to_cpu(tlv_mgmt_frame->header.len);
  52. curr += (sizeof(*tlv_mgmt_frame) + 12);
  53. } else {
  54. mwifiex_dbg(priv->adapter, MSG,
  55. "management frame tlv not found!\n");
  56. return 0;
  57. }
  58. while (evt_len >= sizeof(*ele_hdr)) {
  59. ele_hdr = (struct ieee_types_header *)curr;
  60. ele_len = ele_hdr->len;
  61. if (evt_len < ele_len + sizeof(*ele_hdr))
  62. break;
  63. switch (ele_hdr->element_id) {
  64. case WLAN_EID_HT_CAPABILITY:
  65. sta_ptr->is_11n_enabled = true;
  66. ht_cap = (void *)(ele_hdr + 2);
  67. sta_ptr->max_amsdu = le16_to_cpu(ht_cap->cap_info) &
  68. IEEE80211_HT_CAP_MAX_AMSDU ?
  69. MWIFIEX_TX_DATA_BUF_SIZE_8K :
  70. MWIFIEX_TX_DATA_BUF_SIZE_4K;
  71. mwifiex_dbg(priv->adapter, INFO,
  72. "11n enabled!, max_amsdu : %d\n",
  73. sta_ptr->max_amsdu);
  74. break;
  75. case WLAN_EID_VHT_CAPABILITY:
  76. sta_ptr->is_11ac_enabled = true;
  77. vht_cap = (void *)(ele_hdr + 2);
  78. /* check VHT MAXMPDU capability */
  79. switch (le32_to_cpu(vht_cap->vht_cap_info) & 0x3) {
  80. case IEEE80211_VHT_CAP_MAX_MPDU_LENGTH_11454:
  81. sta_ptr->max_amsdu =
  82. MWIFIEX_TX_DATA_BUF_SIZE_12K;
  83. break;
  84. case IEEE80211_VHT_CAP_MAX_MPDU_LENGTH_7991:
  85. sta_ptr->max_amsdu =
  86. MWIFIEX_TX_DATA_BUF_SIZE_8K;
  87. break;
  88. case IEEE80211_VHT_CAP_MAX_MPDU_LENGTH_3895:
  89. sta_ptr->max_amsdu =
  90. MWIFIEX_TX_DATA_BUF_SIZE_4K;
  91. default:
  92. break;
  93. }
  94. mwifiex_dbg(priv->adapter, INFO,
  95. "11ac enabled!, max_amsdu : %d\n",
  96. sta_ptr->max_amsdu);
  97. break;
  98. default:
  99. break;
  100. }
  101. curr += (ele_len + sizeof(*ele_hdr));
  102. evt_len -= (ele_len + sizeof(*ele_hdr));
  103. }
  104. return 0;
  105. }
  106. /*
  107. * This function resets the connection state.
  108. *
  109. * The function is invoked after receiving a disconnect event from firmware,
  110. * and performs the following actions -
  111. * - Set media status to disconnected
  112. * - Clean up Tx and Rx packets
  113. * - Resets SNR/NF/RSSI value in driver
  114. * - Resets security configurations in driver
  115. * - Enables auto data rate
  116. * - Saves the previous SSID and BSSID so that they can
  117. * be used for re-association, if required
  118. * - Erases current SSID and BSSID information
  119. * - Sends a disconnect event to upper layers/applications.
  120. */
  121. void mwifiex_reset_connect_state(struct mwifiex_private *priv, u16 reason_code,
  122. bool from_ap)
  123. {
  124. struct mwifiex_adapter *adapter = priv->adapter;
  125. if (!priv->media_connected)
  126. return;
  127. mwifiex_dbg(adapter, INFO,
  128. "info: handles disconnect event\n");
  129. priv->media_connected = false;
  130. priv->scan_block = false;
  131. priv->port_open = false;
  132. if ((GET_BSS_ROLE(priv) == MWIFIEX_BSS_ROLE_STA) &&
  133. ISSUPP_TDLS_ENABLED(priv->adapter->fw_cap_info)) {
  134. mwifiex_disable_all_tdls_links(priv);
  135. if (priv->adapter->auto_tdls)
  136. mwifiex_clean_auto_tdls(priv);
  137. }
  138. /* Free Tx and Rx packets, report disconnect to upper layer */
  139. mwifiex_clean_txrx(priv);
  140. /* Reset SNR/NF/RSSI values */
  141. priv->data_rssi_last = 0;
  142. priv->data_nf_last = 0;
  143. priv->data_rssi_avg = 0;
  144. priv->data_nf_avg = 0;
  145. priv->bcn_rssi_last = 0;
  146. priv->bcn_nf_last = 0;
  147. priv->bcn_rssi_avg = 0;
  148. priv->bcn_nf_avg = 0;
  149. priv->rxpd_rate = 0;
  150. priv->rxpd_htinfo = 0;
  151. priv->sec_info.wpa_enabled = false;
  152. priv->sec_info.wpa2_enabled = false;
  153. priv->wpa_ie_len = 0;
  154. priv->sec_info.wapi_enabled = false;
  155. priv->wapi_ie_len = 0;
  156. priv->sec_info.wapi_key_on = false;
  157. priv->sec_info.encryption_mode = 0;
  158. /* Enable auto data rate */
  159. priv->is_data_rate_auto = true;
  160. priv->data_rate = 0;
  161. priv->assoc_resp_ht_param = 0;
  162. priv->ht_param_present = false;
  163. if ((GET_BSS_ROLE(priv) == MWIFIEX_BSS_ROLE_STA ||
  164. GET_BSS_ROLE(priv) == MWIFIEX_BSS_ROLE_UAP) && priv->hist_data)
  165. mwifiex_hist_data_reset(priv);
  166. if (priv->bss_mode == NL80211_IFTYPE_ADHOC) {
  167. priv->adhoc_state = ADHOC_IDLE;
  168. priv->adhoc_is_link_sensed = false;
  169. }
  170. /*
  171. * Memorize the previous SSID and BSSID so
  172. * it could be used for re-assoc
  173. */
  174. mwifiex_dbg(adapter, INFO,
  175. "info: previous SSID=%s, SSID len=%u\n",
  176. priv->prev_ssid.ssid, priv->prev_ssid.ssid_len);
  177. mwifiex_dbg(adapter, INFO,
  178. "info: current SSID=%s, SSID len=%u\n",
  179. priv->curr_bss_params.bss_descriptor.ssid.ssid,
  180. priv->curr_bss_params.bss_descriptor.ssid.ssid_len);
  181. memcpy(&priv->prev_ssid,
  182. &priv->curr_bss_params.bss_descriptor.ssid,
  183. sizeof(struct cfg80211_ssid));
  184. memcpy(priv->prev_bssid,
  185. priv->curr_bss_params.bss_descriptor.mac_address, ETH_ALEN);
  186. /* Need to erase the current SSID and BSSID info */
  187. memset(&priv->curr_bss_params, 0x00, sizeof(priv->curr_bss_params));
  188. adapter->tx_lock_flag = false;
  189. adapter->pps_uapsd_mode = false;
  190. if (adapter->is_cmd_timedout && adapter->curr_cmd)
  191. return;
  192. priv->media_connected = false;
  193. mwifiex_dbg(adapter, MSG,
  194. "info: successfully disconnected from %pM: reason code %d\n",
  195. priv->cfg_bssid, reason_code);
  196. if (priv->bss_mode == NL80211_IFTYPE_STATION ||
  197. priv->bss_mode == NL80211_IFTYPE_P2P_CLIENT) {
  198. cfg80211_disconnected(priv->netdev, reason_code, NULL, 0,
  199. !from_ap, GFP_KERNEL);
  200. }
  201. eth_zero_addr(priv->cfg_bssid);
  202. mwifiex_stop_net_dev_queue(priv->netdev, adapter);
  203. if (netif_carrier_ok(priv->netdev))
  204. netif_carrier_off(priv->netdev);
  205. mwifiex_send_cmd(priv, HostCmd_CMD_GTK_REKEY_OFFLOAD_CFG,
  206. HostCmd_ACT_GEN_REMOVE, 0, NULL, false);
  207. }
  208. static int mwifiex_parse_tdls_event(struct mwifiex_private *priv,
  209. struct sk_buff *event_skb)
  210. {
  211. int ret = 0;
  212. struct mwifiex_adapter *adapter = priv->adapter;
  213. struct mwifiex_sta_node *sta_ptr;
  214. struct mwifiex_tdls_generic_event *tdls_evt =
  215. (void *)event_skb->data + sizeof(adapter->event_cause);
  216. u8 *mac = tdls_evt->peer_mac;
  217. /* reserved 2 bytes are not mandatory in tdls event */
  218. if (event_skb->len < (sizeof(struct mwifiex_tdls_generic_event) -
  219. sizeof(u16) - sizeof(adapter->event_cause))) {
  220. mwifiex_dbg(adapter, ERROR, "Invalid event length!\n");
  221. return -1;
  222. }
  223. sta_ptr = mwifiex_get_sta_entry(priv, tdls_evt->peer_mac);
  224. if (!sta_ptr) {
  225. mwifiex_dbg(adapter, ERROR, "cannot get sta entry!\n");
  226. return -1;
  227. }
  228. switch (le16_to_cpu(tdls_evt->type)) {
  229. case TDLS_EVENT_LINK_TEAR_DOWN:
  230. cfg80211_tdls_oper_request(priv->netdev,
  231. tdls_evt->peer_mac,
  232. NL80211_TDLS_TEARDOWN,
  233. le16_to_cpu(tdls_evt->u.reason_code),
  234. GFP_KERNEL);
  235. break;
  236. case TDLS_EVENT_CHAN_SWITCH_RESULT:
  237. mwifiex_dbg(adapter, EVENT, "tdls channel switch result :\n");
  238. mwifiex_dbg(adapter, EVENT,
  239. "status=0x%x, reason=0x%x cur_chan=%d\n",
  240. tdls_evt->u.switch_result.status,
  241. tdls_evt->u.switch_result.reason,
  242. tdls_evt->u.switch_result.cur_chan);
  243. /* tdls channel switch failed */
  244. if (tdls_evt->u.switch_result.status != 0) {
  245. switch (tdls_evt->u.switch_result.cur_chan) {
  246. case TDLS_BASE_CHANNEL:
  247. sta_ptr->tdls_status = TDLS_IN_BASE_CHAN;
  248. break;
  249. case TDLS_OFF_CHANNEL:
  250. sta_ptr->tdls_status = TDLS_IN_OFF_CHAN;
  251. break;
  252. default:
  253. break;
  254. }
  255. return ret;
  256. }
  257. /* tdls channel switch success */
  258. switch (tdls_evt->u.switch_result.cur_chan) {
  259. case TDLS_BASE_CHANNEL:
  260. if (sta_ptr->tdls_status == TDLS_IN_BASE_CHAN)
  261. break;
  262. mwifiex_update_ralist_tx_pause_in_tdls_cs(priv, mac,
  263. false);
  264. sta_ptr->tdls_status = TDLS_IN_BASE_CHAN;
  265. break;
  266. case TDLS_OFF_CHANNEL:
  267. if (sta_ptr->tdls_status == TDLS_IN_OFF_CHAN)
  268. break;
  269. mwifiex_update_ralist_tx_pause_in_tdls_cs(priv, mac,
  270. true);
  271. sta_ptr->tdls_status = TDLS_IN_OFF_CHAN;
  272. break;
  273. default:
  274. break;
  275. }
  276. break;
  277. case TDLS_EVENT_START_CHAN_SWITCH:
  278. mwifiex_dbg(adapter, EVENT, "tdls start channel switch...\n");
  279. sta_ptr->tdls_status = TDLS_CHAN_SWITCHING;
  280. break;
  281. case TDLS_EVENT_CHAN_SWITCH_STOPPED:
  282. mwifiex_dbg(adapter, EVENT,
  283. "tdls chan switch stopped, reason=%d\n",
  284. tdls_evt->u.cs_stop_reason);
  285. break;
  286. default:
  287. break;
  288. }
  289. return ret;
  290. }
  291. static void mwifiex_process_uap_tx_pause(struct mwifiex_private *priv,
  292. struct mwifiex_ie_types_header *tlv)
  293. {
  294. struct mwifiex_tx_pause_tlv *tp;
  295. struct mwifiex_sta_node *sta_ptr;
  296. unsigned long flags;
  297. tp = (void *)tlv;
  298. mwifiex_dbg(priv->adapter, EVENT,
  299. "uap tx_pause: %pM pause=%d, pkts=%d\n",
  300. tp->peermac, tp->tx_pause,
  301. tp->pkt_cnt);
  302. if (ether_addr_equal(tp->peermac, priv->netdev->dev_addr)) {
  303. if (tp->tx_pause)
  304. priv->port_open = false;
  305. else
  306. priv->port_open = true;
  307. } else if (is_multicast_ether_addr(tp->peermac)) {
  308. mwifiex_update_ralist_tx_pause(priv, tp->peermac, tp->tx_pause);
  309. } else {
  310. spin_lock_irqsave(&priv->sta_list_spinlock, flags);
  311. sta_ptr = mwifiex_get_sta_entry(priv, tp->peermac);
  312. spin_unlock_irqrestore(&priv->sta_list_spinlock, flags);
  313. if (sta_ptr && sta_ptr->tx_pause != tp->tx_pause) {
  314. sta_ptr->tx_pause = tp->tx_pause;
  315. mwifiex_update_ralist_tx_pause(priv, tp->peermac,
  316. tp->tx_pause);
  317. }
  318. }
  319. }
  320. static void mwifiex_process_sta_tx_pause(struct mwifiex_private *priv,
  321. struct mwifiex_ie_types_header *tlv)
  322. {
  323. struct mwifiex_tx_pause_tlv *tp;
  324. struct mwifiex_sta_node *sta_ptr;
  325. int status;
  326. unsigned long flags;
  327. tp = (void *)tlv;
  328. mwifiex_dbg(priv->adapter, EVENT,
  329. "sta tx_pause: %pM pause=%d, pkts=%d\n",
  330. tp->peermac, tp->tx_pause,
  331. tp->pkt_cnt);
  332. if (ether_addr_equal(tp->peermac, priv->cfg_bssid)) {
  333. if (tp->tx_pause)
  334. priv->port_open = false;
  335. else
  336. priv->port_open = true;
  337. } else {
  338. if (!ISSUPP_TDLS_ENABLED(priv->adapter->fw_cap_info))
  339. return;
  340. status = mwifiex_get_tdls_link_status(priv, tp->peermac);
  341. if (mwifiex_is_tdls_link_setup(status)) {
  342. spin_lock_irqsave(&priv->sta_list_spinlock, flags);
  343. sta_ptr = mwifiex_get_sta_entry(priv, tp->peermac);
  344. spin_unlock_irqrestore(&priv->sta_list_spinlock, flags);
  345. if (sta_ptr && sta_ptr->tx_pause != tp->tx_pause) {
  346. sta_ptr->tx_pause = tp->tx_pause;
  347. mwifiex_update_ralist_tx_pause(priv,
  348. tp->peermac,
  349. tp->tx_pause);
  350. }
  351. }
  352. }
  353. }
  354. void mwifiex_process_multi_chan_event(struct mwifiex_private *priv,
  355. struct sk_buff *event_skb)
  356. {
  357. struct mwifiex_ie_types_multi_chan_info *chan_info;
  358. struct mwifiex_ie_types_mc_group_info *grp_info;
  359. struct mwifiex_adapter *adapter = priv->adapter;
  360. struct mwifiex_ie_types_header *tlv;
  361. u16 tlv_buf_left, tlv_type, tlv_len;
  362. int intf_num, bss_type, bss_num, i;
  363. struct mwifiex_private *intf_priv;
  364. tlv_buf_left = event_skb->len - sizeof(u32);
  365. chan_info = (void *)event_skb->data + sizeof(u32);
  366. if (le16_to_cpu(chan_info->header.type) != TLV_TYPE_MULTI_CHAN_INFO ||
  367. tlv_buf_left < sizeof(struct mwifiex_ie_types_multi_chan_info)) {
  368. mwifiex_dbg(adapter, ERROR,
  369. "unknown TLV in chan_info event\n");
  370. return;
  371. }
  372. adapter->usb_mc_status = le16_to_cpu(chan_info->status);
  373. mwifiex_dbg(adapter, EVENT, "multi chan operation %s\n",
  374. adapter->usb_mc_status ? "started" : "over");
  375. tlv_buf_left -= sizeof(struct mwifiex_ie_types_multi_chan_info);
  376. tlv = (struct mwifiex_ie_types_header *)chan_info->tlv_buffer;
  377. while (tlv_buf_left >= (int)sizeof(struct mwifiex_ie_types_header)) {
  378. tlv_type = le16_to_cpu(tlv->type);
  379. tlv_len = le16_to_cpu(tlv->len);
  380. if ((sizeof(struct mwifiex_ie_types_header) + tlv_len) >
  381. tlv_buf_left) {
  382. mwifiex_dbg(adapter, ERROR, "wrong tlv: tlvLen=%d,\t"
  383. "tlvBufLeft=%d\n", tlv_len, tlv_buf_left);
  384. break;
  385. }
  386. if (tlv_type != TLV_TYPE_MC_GROUP_INFO) {
  387. mwifiex_dbg(adapter, ERROR, "wrong tlv type: 0x%x\n",
  388. tlv_type);
  389. break;
  390. }
  391. grp_info = (struct mwifiex_ie_types_mc_group_info *)tlv;
  392. intf_num = grp_info->intf_num;
  393. for (i = 0; i < intf_num; i++) {
  394. bss_type = grp_info->bss_type_numlist[i] >> 4;
  395. bss_num = grp_info->bss_type_numlist[i] & BSS_NUM_MASK;
  396. intf_priv = mwifiex_get_priv_by_id(adapter, bss_num,
  397. bss_type);
  398. if (!intf_priv) {
  399. mwifiex_dbg(adapter, ERROR,
  400. "Invalid bss_type bss_num\t"
  401. "in multi channel event\n");
  402. continue;
  403. }
  404. if (adapter->iface_type == MWIFIEX_USB) {
  405. u8 ep;
  406. ep = grp_info->hid_num.usb_ep_num;
  407. if (ep == MWIFIEX_USB_EP_DATA ||
  408. ep == MWIFIEX_USB_EP_DATA_CH2)
  409. intf_priv->usb_port = ep;
  410. }
  411. }
  412. tlv_buf_left -= sizeof(struct mwifiex_ie_types_header) +
  413. tlv_len;
  414. tlv = (void *)((u8 *)tlv + tlv_len +
  415. sizeof(struct mwifiex_ie_types_header));
  416. }
  417. if (adapter->iface_type == MWIFIEX_USB) {
  418. adapter->tx_lock_flag = true;
  419. adapter->usb_mc_setup = true;
  420. mwifiex_multi_chan_resync(adapter);
  421. }
  422. }
  423. void mwifiex_process_tx_pause_event(struct mwifiex_private *priv,
  424. struct sk_buff *event_skb)
  425. {
  426. struct mwifiex_ie_types_header *tlv;
  427. u16 tlv_type, tlv_len;
  428. int tlv_buf_left;
  429. if (!priv->media_connected) {
  430. mwifiex_dbg(priv->adapter, ERROR,
  431. "tx_pause event while disconnected; bss_role=%d\n",
  432. priv->bss_role);
  433. return;
  434. }
  435. tlv_buf_left = event_skb->len - sizeof(u32);
  436. tlv = (void *)event_skb->data + sizeof(u32);
  437. while (tlv_buf_left >= (int)sizeof(struct mwifiex_ie_types_header)) {
  438. tlv_type = le16_to_cpu(tlv->type);
  439. tlv_len = le16_to_cpu(tlv->len);
  440. if ((sizeof(struct mwifiex_ie_types_header) + tlv_len) >
  441. tlv_buf_left) {
  442. mwifiex_dbg(priv->adapter, ERROR,
  443. "wrong tlv: tlvLen=%d, tlvBufLeft=%d\n",
  444. tlv_len, tlv_buf_left);
  445. break;
  446. }
  447. if (tlv_type == TLV_TYPE_TX_PAUSE) {
  448. if (GET_BSS_ROLE(priv) == MWIFIEX_BSS_ROLE_STA)
  449. mwifiex_process_sta_tx_pause(priv, tlv);
  450. else
  451. mwifiex_process_uap_tx_pause(priv, tlv);
  452. }
  453. tlv_buf_left -= sizeof(struct mwifiex_ie_types_header) +
  454. tlv_len;
  455. tlv = (void *)((u8 *)tlv + tlv_len +
  456. sizeof(struct mwifiex_ie_types_header));
  457. }
  458. }
  459. /*
  460. * This function handles coex events generated by firmware
  461. */
  462. void mwifiex_bt_coex_wlan_param_update_event(struct mwifiex_private *priv,
  463. struct sk_buff *event_skb)
  464. {
  465. struct mwifiex_adapter *adapter = priv->adapter;
  466. struct mwifiex_ie_types_header *tlv;
  467. struct mwifiex_ie_types_btcoex_aggr_win_size *winsizetlv;
  468. struct mwifiex_ie_types_btcoex_scan_time *scantlv;
  469. s32 len = event_skb->len - sizeof(u32);
  470. u8 *cur_ptr = event_skb->data + sizeof(u32);
  471. u16 tlv_type, tlv_len;
  472. while (len >= sizeof(struct mwifiex_ie_types_header)) {
  473. tlv = (struct mwifiex_ie_types_header *)cur_ptr;
  474. tlv_len = le16_to_cpu(tlv->len);
  475. tlv_type = le16_to_cpu(tlv->type);
  476. if ((tlv_len + sizeof(struct mwifiex_ie_types_header)) > len)
  477. break;
  478. switch (tlv_type) {
  479. case TLV_BTCOEX_WL_AGGR_WINSIZE:
  480. winsizetlv =
  481. (struct mwifiex_ie_types_btcoex_aggr_win_size *)tlv;
  482. adapter->coex_win_size = winsizetlv->coex_win_size;
  483. adapter->coex_tx_win_size =
  484. winsizetlv->tx_win_size;
  485. adapter->coex_rx_win_size =
  486. winsizetlv->rx_win_size;
  487. mwifiex_coex_ampdu_rxwinsize(adapter);
  488. mwifiex_update_ampdu_txwinsize(adapter);
  489. break;
  490. case TLV_BTCOEX_WL_SCANTIME:
  491. scantlv =
  492. (struct mwifiex_ie_types_btcoex_scan_time *)tlv;
  493. adapter->coex_scan = scantlv->coex_scan;
  494. adapter->coex_min_scan_time = le16_to_cpu(scantlv->min_scan_time);
  495. adapter->coex_max_scan_time = le16_to_cpu(scantlv->max_scan_time);
  496. break;
  497. default:
  498. break;
  499. }
  500. len -= tlv_len + sizeof(struct mwifiex_ie_types_header);
  501. cur_ptr += tlv_len +
  502. sizeof(struct mwifiex_ie_types_header);
  503. }
  504. dev_dbg(adapter->dev, "coex_scan=%d min_scan=%d coex_win=%d, tx_win=%d rx_win=%d\n",
  505. adapter->coex_scan, adapter->coex_min_scan_time,
  506. adapter->coex_win_size, adapter->coex_tx_win_size,
  507. adapter->coex_rx_win_size);
  508. }
  509. /*
  510. * This function handles events generated by firmware.
  511. *
  512. * This is a generic function and handles all events.
  513. *
  514. * Event specific routines are called by this function based
  515. * upon the generated event cause.
  516. *
  517. * For the following events, the function just forwards them to upper
  518. * layers, optionally recording the change -
  519. * - EVENT_LINK_SENSED
  520. * - EVENT_MIC_ERR_UNICAST
  521. * - EVENT_MIC_ERR_MULTICAST
  522. * - EVENT_PORT_RELEASE
  523. * - EVENT_RSSI_LOW
  524. * - EVENT_SNR_LOW
  525. * - EVENT_MAX_FAIL
  526. * - EVENT_RSSI_HIGH
  527. * - EVENT_SNR_HIGH
  528. * - EVENT_DATA_RSSI_LOW
  529. * - EVENT_DATA_SNR_LOW
  530. * - EVENT_DATA_RSSI_HIGH
  531. * - EVENT_DATA_SNR_HIGH
  532. * - EVENT_LINK_QUALITY
  533. * - EVENT_PRE_BEACON_LOST
  534. * - EVENT_IBSS_COALESCED
  535. * - EVENT_IBSS_STA_CONNECT
  536. * - EVENT_IBSS_STA_DISCONNECT
  537. * - EVENT_WEP_ICV_ERR
  538. * - EVENT_BW_CHANGE
  539. * - EVENT_HOSTWAKE_STAIE
  540. *
  541. * For the following events, no action is taken -
  542. * - EVENT_MIB_CHANGED
  543. * - EVENT_INIT_DONE
  544. * - EVENT_DUMMY_HOST_WAKEUP_SIGNAL
  545. *
  546. * Rest of the supported events requires driver handling -
  547. * - EVENT_DEAUTHENTICATED
  548. * - EVENT_DISASSOCIATED
  549. * - EVENT_LINK_LOST
  550. * - EVENT_PS_SLEEP
  551. * - EVENT_PS_AWAKE
  552. * - EVENT_DEEP_SLEEP_AWAKE
  553. * - EVENT_HS_ACT_REQ
  554. * - EVENT_ADHOC_BCN_LOST
  555. * - EVENT_BG_SCAN_REPORT
  556. * - EVENT_WMM_STATUS_CHANGE
  557. * - EVENT_ADDBA
  558. * - EVENT_DELBA
  559. * - EVENT_BA_STREAM_TIEMOUT
  560. * - EVENT_AMSDU_AGGR_CTRL
  561. */
  562. int mwifiex_process_sta_event(struct mwifiex_private *priv)
  563. {
  564. struct mwifiex_adapter *adapter = priv->adapter;
  565. int ret = 0, i;
  566. u32 eventcause = adapter->event_cause;
  567. u16 ctrl, reason_code;
  568. u8 ibss_sta_addr[ETH_ALEN];
  569. struct mwifiex_sta_node *sta_ptr;
  570. switch (eventcause) {
  571. case EVENT_DUMMY_HOST_WAKEUP_SIGNAL:
  572. mwifiex_dbg(adapter, ERROR,
  573. "invalid EVENT: DUMMY_HOST_WAKEUP_SIGNAL, ignore it\n");
  574. break;
  575. case EVENT_LINK_SENSED:
  576. mwifiex_dbg(adapter, EVENT, "event: LINK_SENSED\n");
  577. if (!netif_carrier_ok(priv->netdev))
  578. netif_carrier_on(priv->netdev);
  579. mwifiex_wake_up_net_dev_queue(priv->netdev, adapter);
  580. break;
  581. case EVENT_DEAUTHENTICATED:
  582. mwifiex_dbg(adapter, EVENT, "event: Deauthenticated\n");
  583. if (priv->wps.session_enable) {
  584. mwifiex_dbg(adapter, INFO,
  585. "info: receive deauth event in wps session\n");
  586. break;
  587. }
  588. adapter->dbg.num_event_deauth++;
  589. if (priv->media_connected) {
  590. reason_code =
  591. le16_to_cpu(*(__le16 *)adapter->event_body);
  592. mwifiex_reset_connect_state(priv, reason_code, true);
  593. }
  594. break;
  595. case EVENT_DISASSOCIATED:
  596. mwifiex_dbg(adapter, EVENT, "event: Disassociated\n");
  597. if (priv->wps.session_enable) {
  598. mwifiex_dbg(adapter, INFO,
  599. "info: receive disassoc event in wps session\n");
  600. break;
  601. }
  602. adapter->dbg.num_event_disassoc++;
  603. if (priv->media_connected) {
  604. reason_code =
  605. le16_to_cpu(*(__le16 *)adapter->event_body);
  606. mwifiex_reset_connect_state(priv, reason_code, true);
  607. }
  608. break;
  609. case EVENT_LINK_LOST:
  610. mwifiex_dbg(adapter, EVENT, "event: Link lost\n");
  611. adapter->dbg.num_event_link_lost++;
  612. if (priv->media_connected) {
  613. reason_code =
  614. le16_to_cpu(*(__le16 *)adapter->event_body);
  615. mwifiex_reset_connect_state(priv, reason_code, true);
  616. }
  617. break;
  618. case EVENT_PS_SLEEP:
  619. mwifiex_dbg(adapter, EVENT, "info: EVENT: SLEEP\n");
  620. adapter->ps_state = PS_STATE_PRE_SLEEP;
  621. mwifiex_check_ps_cond(adapter);
  622. break;
  623. case EVENT_PS_AWAKE:
  624. mwifiex_dbg(adapter, EVENT, "info: EVENT: AWAKE\n");
  625. if (!adapter->pps_uapsd_mode &&
  626. (priv->port_open ||
  627. (priv->bss_mode == NL80211_IFTYPE_ADHOC)) &&
  628. priv->media_connected && adapter->sleep_period.period) {
  629. adapter->pps_uapsd_mode = true;
  630. mwifiex_dbg(adapter, EVENT,
  631. "event: PPS/UAPSD mode activated\n");
  632. }
  633. adapter->tx_lock_flag = false;
  634. if (adapter->pps_uapsd_mode && adapter->gen_null_pkt) {
  635. if (mwifiex_check_last_packet_indication(priv)) {
  636. if (adapter->data_sent ||
  637. (adapter->if_ops.is_port_ready &&
  638. !adapter->if_ops.is_port_ready(priv))) {
  639. adapter->ps_state = PS_STATE_AWAKE;
  640. adapter->pm_wakeup_card_req = false;
  641. adapter->pm_wakeup_fw_try = false;
  642. del_timer(&adapter->wakeup_timer);
  643. break;
  644. }
  645. if (!mwifiex_send_null_packet
  646. (priv,
  647. MWIFIEX_TxPD_POWER_MGMT_NULL_PACKET |
  648. MWIFIEX_TxPD_POWER_MGMT_LAST_PACKET))
  649. adapter->ps_state =
  650. PS_STATE_SLEEP;
  651. return 0;
  652. }
  653. }
  654. adapter->ps_state = PS_STATE_AWAKE;
  655. adapter->pm_wakeup_card_req = false;
  656. adapter->pm_wakeup_fw_try = false;
  657. del_timer(&adapter->wakeup_timer);
  658. break;
  659. case EVENT_DEEP_SLEEP_AWAKE:
  660. adapter->if_ops.wakeup_complete(adapter);
  661. mwifiex_dbg(adapter, EVENT, "event: DS_AWAKE\n");
  662. if (adapter->is_deep_sleep)
  663. adapter->is_deep_sleep = false;
  664. break;
  665. case EVENT_HS_ACT_REQ:
  666. mwifiex_dbg(adapter, EVENT, "event: HS_ACT_REQ\n");
  667. ret = mwifiex_send_cmd(priv, HostCmd_CMD_802_11_HS_CFG_ENH,
  668. 0, 0, NULL, false);
  669. break;
  670. case EVENT_MIC_ERR_UNICAST:
  671. mwifiex_dbg(adapter, EVENT, "event: UNICAST MIC ERROR\n");
  672. cfg80211_michael_mic_failure(priv->netdev, priv->cfg_bssid,
  673. NL80211_KEYTYPE_PAIRWISE,
  674. -1, NULL, GFP_KERNEL);
  675. break;
  676. case EVENT_MIC_ERR_MULTICAST:
  677. mwifiex_dbg(adapter, EVENT, "event: MULTICAST MIC ERROR\n");
  678. cfg80211_michael_mic_failure(priv->netdev, priv->cfg_bssid,
  679. NL80211_KEYTYPE_GROUP,
  680. -1, NULL, GFP_KERNEL);
  681. break;
  682. case EVENT_MIB_CHANGED:
  683. case EVENT_INIT_DONE:
  684. break;
  685. case EVENT_ADHOC_BCN_LOST:
  686. mwifiex_dbg(adapter, EVENT, "event: ADHOC_BCN_LOST\n");
  687. priv->adhoc_is_link_sensed = false;
  688. mwifiex_clean_txrx(priv);
  689. mwifiex_stop_net_dev_queue(priv->netdev, adapter);
  690. if (netif_carrier_ok(priv->netdev))
  691. netif_carrier_off(priv->netdev);
  692. break;
  693. case EVENT_BG_SCAN_REPORT:
  694. mwifiex_dbg(adapter, EVENT, "event: BGS_REPORT\n");
  695. ret = mwifiex_send_cmd(priv, HostCmd_CMD_802_11_BG_SCAN_QUERY,
  696. HostCmd_ACT_GEN_GET, 0, NULL, false);
  697. break;
  698. case EVENT_BG_SCAN_STOPPED:
  699. dev_dbg(adapter->dev, "event: BGS_STOPPED\n");
  700. cfg80211_sched_scan_stopped(priv->wdev.wiphy);
  701. if (priv->sched_scanning)
  702. priv->sched_scanning = false;
  703. break;
  704. case EVENT_PORT_RELEASE:
  705. mwifiex_dbg(adapter, EVENT, "event: PORT RELEASE\n");
  706. priv->port_open = true;
  707. break;
  708. case EVENT_EXT_SCAN_REPORT:
  709. mwifiex_dbg(adapter, EVENT, "event: EXT_SCAN Report\n");
  710. /* We intend to skip this event during suspend, but handle
  711. * it in interface disabled case
  712. */
  713. if (adapter->ext_scan && (!priv->scan_aborting ||
  714. !netif_running(priv->netdev)))
  715. ret = mwifiex_handle_event_ext_scan_report(priv,
  716. adapter->event_skb->data);
  717. break;
  718. case EVENT_WMM_STATUS_CHANGE:
  719. mwifiex_dbg(adapter, EVENT, "event: WMM status changed\n");
  720. ret = mwifiex_send_cmd(priv, HostCmd_CMD_WMM_GET_STATUS,
  721. 0, 0, NULL, false);
  722. break;
  723. case EVENT_RSSI_LOW:
  724. cfg80211_cqm_rssi_notify(priv->netdev,
  725. NL80211_CQM_RSSI_THRESHOLD_EVENT_LOW,
  726. GFP_KERNEL);
  727. mwifiex_send_cmd(priv, HostCmd_CMD_RSSI_INFO,
  728. HostCmd_ACT_GEN_GET, 0, NULL, false);
  729. priv->subsc_evt_rssi_state = RSSI_LOW_RECVD;
  730. mwifiex_dbg(adapter, EVENT, "event: Beacon RSSI_LOW\n");
  731. break;
  732. case EVENT_SNR_LOW:
  733. mwifiex_dbg(adapter, EVENT, "event: Beacon SNR_LOW\n");
  734. break;
  735. case EVENT_MAX_FAIL:
  736. mwifiex_dbg(adapter, EVENT, "event: MAX_FAIL\n");
  737. break;
  738. case EVENT_RSSI_HIGH:
  739. cfg80211_cqm_rssi_notify(priv->netdev,
  740. NL80211_CQM_RSSI_THRESHOLD_EVENT_HIGH,
  741. GFP_KERNEL);
  742. mwifiex_send_cmd(priv, HostCmd_CMD_RSSI_INFO,
  743. HostCmd_ACT_GEN_GET, 0, NULL, false);
  744. priv->subsc_evt_rssi_state = RSSI_HIGH_RECVD;
  745. mwifiex_dbg(adapter, EVENT, "event: Beacon RSSI_HIGH\n");
  746. break;
  747. case EVENT_SNR_HIGH:
  748. mwifiex_dbg(adapter, EVENT, "event: Beacon SNR_HIGH\n");
  749. break;
  750. case EVENT_DATA_RSSI_LOW:
  751. mwifiex_dbg(adapter, EVENT, "event: Data RSSI_LOW\n");
  752. break;
  753. case EVENT_DATA_SNR_LOW:
  754. mwifiex_dbg(adapter, EVENT, "event: Data SNR_LOW\n");
  755. break;
  756. case EVENT_DATA_RSSI_HIGH:
  757. mwifiex_dbg(adapter, EVENT, "event: Data RSSI_HIGH\n");
  758. break;
  759. case EVENT_DATA_SNR_HIGH:
  760. mwifiex_dbg(adapter, EVENT, "event: Data SNR_HIGH\n");
  761. break;
  762. case EVENT_LINK_QUALITY:
  763. mwifiex_dbg(adapter, EVENT, "event: Link Quality\n");
  764. break;
  765. case EVENT_PRE_BEACON_LOST:
  766. mwifiex_dbg(adapter, EVENT, "event: Pre-Beacon Lost\n");
  767. break;
  768. case EVENT_IBSS_COALESCED:
  769. mwifiex_dbg(adapter, EVENT, "event: IBSS_COALESCED\n");
  770. ret = mwifiex_send_cmd(priv,
  771. HostCmd_CMD_802_11_IBSS_COALESCING_STATUS,
  772. HostCmd_ACT_GEN_GET, 0, NULL, false);
  773. break;
  774. case EVENT_IBSS_STA_CONNECT:
  775. ether_addr_copy(ibss_sta_addr, adapter->event_body + 2);
  776. mwifiex_dbg(adapter, EVENT, "event: IBSS_STA_CONNECT %pM\n",
  777. ibss_sta_addr);
  778. sta_ptr = mwifiex_add_sta_entry(priv, ibss_sta_addr);
  779. if (sta_ptr && adapter->adhoc_11n_enabled) {
  780. mwifiex_check_ibss_peer_capabilties(priv, sta_ptr,
  781. adapter->event_skb);
  782. if (sta_ptr->is_11n_enabled)
  783. for (i = 0; i < MAX_NUM_TID; i++)
  784. sta_ptr->ampdu_sta[i] =
  785. priv->aggr_prio_tbl[i].ampdu_user;
  786. else
  787. for (i = 0; i < MAX_NUM_TID; i++)
  788. sta_ptr->ampdu_sta[i] =
  789. BA_STREAM_NOT_ALLOWED;
  790. memset(sta_ptr->rx_seq, 0xff, sizeof(sta_ptr->rx_seq));
  791. }
  792. break;
  793. case EVENT_IBSS_STA_DISCONNECT:
  794. ether_addr_copy(ibss_sta_addr, adapter->event_body + 2);
  795. mwifiex_dbg(adapter, EVENT, "event: IBSS_STA_DISCONNECT %pM\n",
  796. ibss_sta_addr);
  797. sta_ptr = mwifiex_get_sta_entry(priv, ibss_sta_addr);
  798. if (sta_ptr && sta_ptr->is_11n_enabled) {
  799. mwifiex_11n_del_rx_reorder_tbl_by_ta(priv,
  800. ibss_sta_addr);
  801. mwifiex_del_tx_ba_stream_tbl_by_ra(priv, ibss_sta_addr);
  802. }
  803. mwifiex_wmm_del_peer_ra_list(priv, ibss_sta_addr);
  804. mwifiex_del_sta_entry(priv, ibss_sta_addr);
  805. break;
  806. case EVENT_ADDBA:
  807. mwifiex_dbg(adapter, EVENT, "event: ADDBA Request\n");
  808. mwifiex_send_cmd(priv, HostCmd_CMD_11N_ADDBA_RSP,
  809. HostCmd_ACT_GEN_SET, 0,
  810. adapter->event_body, false);
  811. break;
  812. case EVENT_DELBA:
  813. mwifiex_dbg(adapter, EVENT, "event: DELBA Request\n");
  814. mwifiex_11n_delete_ba_stream(priv, adapter->event_body);
  815. break;
  816. case EVENT_BA_STREAM_TIEMOUT:
  817. mwifiex_dbg(adapter, EVENT, "event: BA Stream timeout\n");
  818. mwifiex_11n_ba_stream_timeout(priv,
  819. (struct host_cmd_ds_11n_batimeout
  820. *)
  821. adapter->event_body);
  822. break;
  823. case EVENT_AMSDU_AGGR_CTRL:
  824. ctrl = le16_to_cpu(*(__le16 *)adapter->event_body);
  825. mwifiex_dbg(adapter, EVENT,
  826. "event: AMSDU_AGGR_CTRL %d\n", ctrl);
  827. adapter->tx_buf_size =
  828. min_t(u16, adapter->curr_tx_buf_size, ctrl);
  829. mwifiex_dbg(adapter, EVENT, "event: tx_buf_size %d\n",
  830. adapter->tx_buf_size);
  831. break;
  832. case EVENT_WEP_ICV_ERR:
  833. mwifiex_dbg(adapter, EVENT, "event: WEP ICV error\n");
  834. break;
  835. case EVENT_BW_CHANGE:
  836. mwifiex_dbg(adapter, EVENT, "event: BW Change\n");
  837. break;
  838. case EVENT_HOSTWAKE_STAIE:
  839. mwifiex_dbg(adapter, EVENT,
  840. "event: HOSTWAKE_STAIE %d\n", eventcause);
  841. break;
  842. case EVENT_REMAIN_ON_CHAN_EXPIRED:
  843. mwifiex_dbg(adapter, EVENT,
  844. "event: Remain on channel expired\n");
  845. cfg80211_remain_on_channel_expired(&priv->wdev,
  846. priv->roc_cfg.cookie,
  847. &priv->roc_cfg.chan,
  848. GFP_ATOMIC);
  849. memset(&priv->roc_cfg, 0x00, sizeof(struct mwifiex_roc_cfg));
  850. break;
  851. case EVENT_CHANNEL_SWITCH_ANN:
  852. mwifiex_dbg(adapter, EVENT, "event: Channel Switch Announcement\n");
  853. priv->csa_expire_time =
  854. jiffies + msecs_to_jiffies(DFS_CHAN_MOVE_TIME);
  855. priv->csa_chan = priv->curr_bss_params.bss_descriptor.channel;
  856. ret = mwifiex_send_cmd(priv, HostCmd_CMD_802_11_DEAUTHENTICATE,
  857. HostCmd_ACT_GEN_SET, 0,
  858. priv->curr_bss_params.bss_descriptor.mac_address,
  859. false);
  860. break;
  861. case EVENT_TDLS_GENERIC_EVENT:
  862. ret = mwifiex_parse_tdls_event(priv, adapter->event_skb);
  863. break;
  864. case EVENT_TX_DATA_PAUSE:
  865. mwifiex_dbg(adapter, EVENT, "event: TX DATA PAUSE\n");
  866. mwifiex_process_tx_pause_event(priv, adapter->event_skb);
  867. break;
  868. case EVENT_MULTI_CHAN_INFO:
  869. mwifiex_dbg(adapter, EVENT, "event: multi-chan info\n");
  870. mwifiex_process_multi_chan_event(priv, adapter->event_skb);
  871. break;
  872. case EVENT_TX_STATUS_REPORT:
  873. mwifiex_dbg(adapter, EVENT, "event: TX_STATUS Report\n");
  874. mwifiex_parse_tx_status_event(priv, adapter->event_body);
  875. break;
  876. case EVENT_CHANNEL_REPORT_RDY:
  877. mwifiex_dbg(adapter, EVENT, "event: Channel Report\n");
  878. ret = mwifiex_11h_handle_chanrpt_ready(priv,
  879. adapter->event_skb);
  880. break;
  881. case EVENT_RADAR_DETECTED:
  882. mwifiex_dbg(adapter, EVENT, "event: Radar detected\n");
  883. ret = mwifiex_11h_handle_radar_detected(priv,
  884. adapter->event_skb);
  885. break;
  886. case EVENT_BT_COEX_WLAN_PARA_CHANGE:
  887. dev_dbg(adapter->dev, "EVENT: BT coex wlan param update\n");
  888. mwifiex_bt_coex_wlan_param_update_event(priv,
  889. adapter->event_skb);
  890. break;
  891. case EVENT_RXBA_SYNC:
  892. dev_dbg(adapter->dev, "EVENT: RXBA_SYNC\n");
  893. mwifiex_11n_rxba_sync_event(priv, adapter->event_body,
  894. adapter->event_skb->len -
  895. sizeof(eventcause));
  896. break;
  897. default:
  898. mwifiex_dbg(adapter, ERROR, "event: unknown event id: %#x\n",
  899. eventcause);
  900. break;
  901. }
  902. return ret;
  903. }