drivers/net/wireless/marvell/mwifiex/uap_event.c

   1 /*
   2  * NXP Wireless LAN device driver: AP event handling
   3  *
   4  * Copyright 2011-2020 NXP
   5  *
   6  * This software file (the "File") is distributed by NXP
   7  * 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
  20 #include "decl.h"
  21 #include "main.h"
  22 #include "11n.h"
  23
  24 #define MWIFIEX_BSS_START_EVT_FIX_SIZE    12
  25
  26 static int mwifiex_check_uap_capabilities(struct mwifiex_private *priv,
  27                                           struct sk_buff *event)
  28 {
  29         int evt_len;
  30         u8 *curr;
  31         u16 tlv_len;
  32         struct mwifiex_ie_types_data *tlv_hdr;
  33         struct ieee_types_wmm_parameter *wmm_param_ie = NULL;
  34         int mask = IEEE80211_WMM_IE_AP_QOSINFO_PARAM_SET_CNT_MASK;
  35
  36         priv->wmm_enabled = false;
  37         skb_pull(event, MWIFIEX_BSS_START_EVT_FIX_SIZE);
  38         evt_len = event->len;
  39         curr = event->data;
  40
  41         mwifiex_dbg_dump(priv->adapter, EVT_D, "uap capabilities:",
  42                          event->data, event->len);
  43
  44         skb_push(event, MWIFIEX_BSS_START_EVT_FIX_SIZE);
  45
  46         while ((evt_len >= sizeof(tlv_hdr->header))) {
  47                 tlv_hdr = (struct mwifiex_ie_types_data *)curr;
  48                 tlv_len = le16_to_cpu(tlv_hdr->header.len);
  49
  50                 if (evt_len < tlv_len + sizeof(tlv_hdr->header))
  51                         break;
  52
  53                 switch (le16_to_cpu(tlv_hdr->header.type)) {
  54                 case WLAN_EID_HT_CAPABILITY:
  55                         priv->ap_11n_enabled = true;
  56                         break;
  57
  58                 case WLAN_EID_VHT_CAPABILITY:
  59                         priv->ap_11ac_enabled = true;
  60                         break;
  61
  62                 case WLAN_EID_VENDOR_SPECIFIC:
  63                         /* Point the regular IEEE IE 2 bytes into the Marvell IE
  64                          * and setup the IEEE IE type and length byte fields
  65                          */
  66                         wmm_param_ie = (void *)(curr + 2);
  67                         wmm_param_ie->vend_hdr.len = (u8)tlv_len;
  68                         wmm_param_ie->vend_hdr.element_id =
  69                                                 WLAN_EID_VENDOR_SPECIFIC;
  70                         mwifiex_dbg(priv->adapter, EVENT,
  71                                     "info: check uap capabilities:\t"
  72                                     "wmm parameter set count: %d\n",
  73                                     wmm_param_ie->qos_info_bitmap & mask);
  74
  75                         mwifiex_wmm_setup_ac_downgrade(priv);
  76                         priv->wmm_enabled = true;
  77                         mwifiex_wmm_setup_queue_priorities(priv, wmm_param_ie);
  78                         break;
  79
  80                 default:
  81                         break;
  82                 }
  83
  84                 curr += (tlv_len + sizeof(tlv_hdr->header));
  85                 evt_len -= (tlv_len + sizeof(tlv_hdr->header));
  86         }
  87
  88         return 0;
  89 }
  90
  91 /*
  92  * This function handles AP interface specific events generated by firmware.
  93  *
  94  * Event specific routines are called by this function based
  95  * upon the generated event cause.
  96  *
  97  *
  98  * Events supported for AP -
  99  *      - EVENT_UAP_STA_ASSOC
 100  *      - EVENT_UAP_STA_DEAUTH
 101  *      - EVENT_UAP_BSS_ACTIVE
 102  *      - EVENT_UAP_BSS_START
 103  *      - EVENT_UAP_BSS_IDLE
 104  *      - EVENT_UAP_MIC_COUNTERMEASURES:
 105  */
 106 int mwifiex_process_uap_event(struct mwifiex_private *priv)
 107 {
 108         struct mwifiex_adapter *adapter = priv->adapter;
 109         int len, i;
 110         u32 eventcause = adapter->event_cause;
 111         struct station_info *sinfo;
 112         struct mwifiex_assoc_event *event;
 113         struct mwifiex_sta_node *node;
 114         u8 *deauth_mac;
 115         struct host_cmd_ds_11n_batimeout *ba_timeout;
 116         u16 ctrl;
 117
 118         switch (eventcause) {
 119         case EVENT_UAP_STA_ASSOC:
 120                 sinfo = kzalloc(sizeof(*sinfo), GFP_KERNEL);
 121                 if (!sinfo)
 122                         return -ENOMEM;
 123
 124                 event = (struct mwifiex_assoc_event *)
 125                         (adapter->event_body + MWIFIEX_UAP_EVENT_EXTRA_HEADER);
 126                 if (le16_to_cpu(event->type) == TLV_TYPE_UAP_MGMT_FRAME) {
 127                         len = -1;
 128
 129                         if (ieee80211_is_assoc_req(event->frame_control))
 130                                 len = 0;
 131                         else if (ieee80211_is_reassoc_req(event->frame_control))
 132                                 /* There will be ETH_ALEN bytes of
 133                                  * current_ap_addr before the re-assoc ies.
 134                                  */
 135                                 len = ETH_ALEN;
 136
 137                         if (len != -1) {
 138                                 sinfo->assoc_req_ies = &event->data[len];
 139                                 len = (u8 *)sinfo->assoc_req_ies -
 140                                       (u8 *)&event->frame_control;
 141                                 sinfo->assoc_req_ies_len =
 142                                         le16_to_cpu(event->len) - (u16)len;
 143                         }
 144                 }
 145                 cfg80211_new_sta(priv->netdev, event->sta_addr, sinfo,
 146                                  GFP_KERNEL);
 147
 148                 node = mwifiex_add_sta_entry(priv, event->sta_addr);
 149                 if (!node) {
 150                         mwifiex_dbg(adapter, ERROR,
 151                                     "could not create station entry!\n");
 152                         kfree(sinfo);
 153                         return -1;
 154                 }
 155
 156                 if (!priv->ap_11n_enabled) {
 157                         kfree(sinfo);
 158                         break;
 159                 }
 160
 161                 mwifiex_set_sta_ht_cap(priv, sinfo->assoc_req_ies,
 162                                        sinfo->assoc_req_ies_len, node);
 163
 164                 for (i = 0; i < MAX_NUM_TID; i++) {
 165                         if (node->is_11n_enabled)
 166                                 node->ampdu_sta[i] =
 167                                               priv->aggr_prio_tbl[i].ampdu_user;
 168                         else
 169                                 node->ampdu_sta[i] = BA_STREAM_NOT_ALLOWED;
 170                 }
 171                 memset(node->rx_seq, 0xff, sizeof(node->rx_seq));
 172                 kfree(sinfo);
 173                 break;
 174         case EVENT_UAP_STA_DEAUTH:
 175                 deauth_mac = adapter->event_body +
 176                              MWIFIEX_UAP_EVENT_EXTRA_HEADER;
 177                 cfg80211_del_sta(priv->netdev, deauth_mac, GFP_KERNEL);
 178
 179                 if (priv->ap_11n_enabled) {
 180                         mwifiex_11n_del_rx_reorder_tbl_by_ta(priv, deauth_mac);
 181                         mwifiex_del_tx_ba_stream_tbl_by_ra(priv, deauth_mac);
 182                 }
 183                 mwifiex_wmm_del_peer_ra_list(priv, deauth_mac);
 184                 mwifiex_del_sta_entry(priv, deauth_mac);
 185                 break;
 186         case EVENT_UAP_BSS_IDLE:
 187                 priv->media_connected = false;
 188                 priv->port_open = false;
 189                 mwifiex_clean_txrx(priv);
 190                 mwifiex_del_all_sta_list(priv);
 191                 break;
 192         case EVENT_UAP_BSS_ACTIVE:
 193                 priv->media_connected = true;
 194                 priv->port_open = true;
 195                 break;
 196         case EVENT_UAP_BSS_START:
 197                 mwifiex_dbg(adapter, EVENT,
 198                             "AP EVENT: event id: %#x\n", eventcause);
 199                 priv->port_open = false;
 200                 eth_hw_addr_set(priv->netdev, adapter->event_body + 2);
 201                 if (priv->hist_data)
 202                         mwifiex_hist_data_reset(priv);
 203                 mwifiex_check_uap_capabilities(priv, adapter->event_skb);
 204                 break;
 205         case EVENT_UAP_MIC_COUNTERMEASURES:
 206                 /* For future development */
 207                 mwifiex_dbg(adapter, EVENT,
 208                             "AP EVENT: event id: %#x\n", eventcause);
 209                 break;
 210         case EVENT_AMSDU_AGGR_CTRL:
 211                 ctrl = get_unaligned_le16(adapter->event_body);
 212                 mwifiex_dbg(adapter, EVENT,
 213                             "event: AMSDU_AGGR_CTRL %d\n", ctrl);
 214
 215                 if (priv->media_connected) {
 216                         adapter->tx_buf_size =
 217                                 min_t(u16, adapter->curr_tx_buf_size, ctrl);
 218                         mwifiex_dbg(adapter, EVENT,
 219                                     "event: tx_buf_size %d\n",
 220                                     adapter->tx_buf_size);
 221                 }
 222                 break;
 223         case EVENT_ADDBA:
 224                 mwifiex_dbg(adapter, EVENT, "event: ADDBA Request\n");
 225                 if (priv->media_connected)
 226                         mwifiex_send_cmd(priv, HostCmd_CMD_11N_ADDBA_RSP,
 227                                          HostCmd_ACT_GEN_SET, 0,
 228                                          adapter->event_body, false);
 229                 break;
 230         case EVENT_DELBA:
 231                 mwifiex_dbg(adapter, EVENT, "event: DELBA Request\n");
 232                 if (priv->media_connected)
 233                         mwifiex_11n_delete_ba_stream(priv, adapter->event_body);
 234                 break;
 235         case EVENT_BA_STREAM_TIEMOUT:
 236                 mwifiex_dbg(adapter, EVENT, "event:  BA Stream timeout\n");
 237                 if (priv->media_connected) {
 238                         ba_timeout = (void *)adapter->event_body;
 239                         mwifiex_11n_ba_stream_timeout(priv, ba_timeout);
 240                 }
 241                 break;
 242         case EVENT_EXT_SCAN_REPORT:
 243                 mwifiex_dbg(adapter, EVENT, "event: EXT_SCAN Report\n");
 244                 if (adapter->ext_scan)
 245                         return mwifiex_handle_event_ext_scan_report(priv,
 246                                                 adapter->event_skb->data);
 247                 break;
 248         case EVENT_TX_STATUS_REPORT:
 249                 mwifiex_dbg(adapter, EVENT, "event: TX_STATUS Report\n");
 250                 mwifiex_parse_tx_status_event(priv, adapter->event_body);
 251                 break;
 252         case EVENT_PS_SLEEP:
 253                 mwifiex_dbg(adapter, EVENT, "info: EVENT: SLEEP\n");
 254
 255                 adapter->ps_state = PS_STATE_PRE_SLEEP;
 256
 257                 mwifiex_check_ps_cond(adapter);
 258                 break;
 259
 260         case EVENT_PS_AWAKE:
 261                 mwifiex_dbg(adapter, EVENT, "info: EVENT: AWAKE\n");
 262                 if (!adapter->pps_uapsd_mode &&
 263                     priv->media_connected && adapter->sleep_period.period) {
 264                                 adapter->pps_uapsd_mode = true;
 265                                 mwifiex_dbg(adapter, EVENT,
 266                                             "event: PPS/UAPSD mode activated\n");
 267                 }
 268                 adapter->tx_lock_flag = false;
 269                 if (adapter->pps_uapsd_mode && adapter->gen_null_pkt) {
 270                         if (mwifiex_check_last_packet_indication(priv)) {
 271                                 if (adapter->data_sent ||
 272                                     (adapter->if_ops.is_port_ready &&
 273                                      !adapter->if_ops.is_port_ready(priv))) {
 274                                         adapter->ps_state = PS_STATE_AWAKE;
 275                                         adapter->pm_wakeup_card_req = false;
 276                                         adapter->pm_wakeup_fw_try = false;
 277                                         break;
 278                                 }
 279                                 if (!mwifiex_send_null_packet
 280                                         (priv,
 281                                          MWIFIEX_TxPD_POWER_MGMT_NULL_PACKET |
 282                                          MWIFIEX_TxPD_POWER_MGMT_LAST_PACKET))
 283                                                 adapter->ps_state =
 284                                                         PS_STATE_SLEEP;
 285                                         return 0;
 286                         }
 287                 }
 288                 adapter->ps_state = PS_STATE_AWAKE;
 289                 adapter->pm_wakeup_card_req = false;
 290                 adapter->pm_wakeup_fw_try = false;
 291                 break;
 292
 293         case EVENT_CHANNEL_REPORT_RDY:
 294                 mwifiex_dbg(adapter, EVENT, "event: Channel Report\n");
 295                 mwifiex_11h_handle_chanrpt_ready(priv, adapter->event_skb);
 296                 break;
 297         case EVENT_RADAR_DETECTED:
 298                 mwifiex_dbg(adapter, EVENT, "event: Radar detected\n");
 299                 mwifiex_11h_handle_radar_detected(priv, adapter->event_skb);
 300                 break;
 301         case EVENT_BT_COEX_WLAN_PARA_CHANGE:
 302                 mwifiex_dbg(adapter, EVENT, "event: BT coex wlan param update\n");
 303                 mwifiex_bt_coex_wlan_param_update_event(priv,
 304                                                         adapter->event_skb);
 305                 break;
 306         case EVENT_TX_DATA_PAUSE:
 307                 mwifiex_dbg(adapter, EVENT, "event: TX DATA PAUSE\n");
 308                 mwifiex_process_tx_pause_event(priv, adapter->event_skb);
 309                 break;
 310
 311         case EVENT_MULTI_CHAN_INFO:
 312                 mwifiex_dbg(adapter, EVENT, "event: multi-chan info\n");
 313                 mwifiex_process_multi_chan_event(priv, adapter->event_skb);
 314                 break;
 315         case EVENT_RXBA_SYNC:
 316                 dev_dbg(adapter->dev, "EVENT: RXBA_SYNC\n");
 317                 mwifiex_11n_rxba_sync_event(priv, adapter->event_body,
 318                                             adapter->event_skb->len -
 319                                             sizeof(eventcause));
 320                 break;
 321
 322         case EVENT_REMAIN_ON_CHAN_EXPIRED:
 323                 mwifiex_dbg(adapter, EVENT,
 324                             "event: uap: Remain on channel expired\n");
 325                 cfg80211_remain_on_channel_expired(&priv->wdev,
 326                                                    priv->roc_cfg.cookie,
 327                                                    &priv->roc_cfg.chan,
 328                                                    GFP_ATOMIC);
 329                 memset(&priv->roc_cfg, 0x00, sizeof(struct mwifiex_roc_cfg));
 330                 break;
 331
 332         default:
 333                 mwifiex_dbg(adapter, EVENT,
 334                             "event: unknown event id: %#x\n", eventcause);
 335                 break;
 336         }
 337
 338         return 0;
 339 }
 340
 341 /* This function deletes station entry from associated station list.
 342  * Also if both AP and STA are 11n enabled, RxReorder tables and TxBA stream
 343  * tables created for this station are deleted.
 344  */
 345 void mwifiex_uap_del_sta_data(struct mwifiex_private *priv,
 346                               struct mwifiex_sta_node *node)
 347 {
 348         if (priv->ap_11n_enabled && node->is_11n_enabled) {
 349                 mwifiex_11n_del_rx_reorder_tbl_by_ta(priv, node->mac_addr);
 350                 mwifiex_del_tx_ba_stream_tbl_by_ra(priv, node->mac_addr);
 351         }
 352         mwifiex_del_sta_entry(priv, node->mac_addr);
 353
 354         return;
 355 }