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

   1 /*
   2  * NXP Wireless LAN device driver: generic TX/RX data 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 "ioctl.h"
  22 #include "util.h"
  23 #include "fw.h"
  24 #include "main.h"
  25 #include "wmm.h"
  26
  27 /*
  28  * This function processes the received buffer.
  29  *
  30  * Main responsibility of this function is to parse the RxPD to
  31  * identify the correct interface this packet is headed for and
  32  * forwarding it to the associated handling function, where the
  33  * packet will be further processed and sent to kernel/upper layer
  34  * if required.
  35  */
  36 int mwifiex_handle_rx_packet(struct mwifiex_adapter *adapter,
  37                              struct sk_buff *skb)
  38 {
  39         struct mwifiex_private *priv =
  40                 mwifiex_get_priv(adapter, MWIFIEX_BSS_ROLE_ANY);
  41         struct rxpd *local_rx_pd;
  42         struct mwifiex_rxinfo *rx_info = MWIFIEX_SKB_RXCB(skb);
  43         int ret;
  44
  45         local_rx_pd = (struct rxpd *) (skb->data);
  46         /* Get the BSS number from rxpd, get corresponding priv */
  47         priv = mwifiex_get_priv_by_id(adapter, local_rx_pd->bss_num &
  48                                       BSS_NUM_MASK, local_rx_pd->bss_type);
  49         if (!priv)
  50                 priv = mwifiex_get_priv(adapter, MWIFIEX_BSS_ROLE_ANY);
  51
  52         if (!priv) {
  53                 mwifiex_dbg(adapter, ERROR,
  54                             "data: priv not found. Drop RX packet\n");
  55                 dev_kfree_skb_any(skb);
  56                 return -1;
  57         }
  58
  59         mwifiex_dbg_dump(adapter, DAT_D, "rx pkt:", skb->data,
  60                          min_t(size_t, skb->len, DEBUG_DUMP_DATA_MAX_LEN));
  61
  62         memset(rx_info, 0, sizeof(*rx_info));
  63         rx_info->bss_num = priv->bss_num;
  64         rx_info->bss_type = priv->bss_type;
  65
  66         if (priv->bss_role == MWIFIEX_BSS_ROLE_UAP)
  67                 ret = mwifiex_process_uap_rx_packet(priv, skb);
  68         else
  69                 ret = mwifiex_process_sta_rx_packet(priv, skb);
  70
  71         return ret;
  72 }
  73 EXPORT_SYMBOL_GPL(mwifiex_handle_rx_packet);
  74
  75 /*
  76  * This function sends a packet to device.
  77  *
  78  * It processes the packet to add the TxPD, checks condition and
  79  * sends the processed packet to firmware for transmission.
  80  *
  81  * On successful completion, the function calls the completion callback
  82  * and logs the time.
  83  */
  84 int mwifiex_process_tx(struct mwifiex_private *priv, struct sk_buff *skb,
  85                        struct mwifiex_tx_param *tx_param)
  86 {
  87         int hroom, ret = -1;
  88         struct mwifiex_adapter *adapter = priv->adapter;
  89         u8 *head_ptr;
  90         struct txpd *local_tx_pd = NULL;
  91         struct mwifiex_sta_node *dest_node;
  92         struct ethhdr *hdr = (void *)skb->data;
  93
  94         hroom = adapter->intf_hdr_len;
  95
  96         if (priv->bss_role == MWIFIEX_BSS_ROLE_UAP) {
  97                 dest_node = mwifiex_get_sta_entry(priv, hdr->h_dest);
  98                 if (dest_node) {
  99                         dest_node->stats.tx_bytes += skb->len;
 100                         dest_node->stats.tx_packets++;
 101                 }
 102
 103                 head_ptr = mwifiex_process_uap_txpd(priv, skb);
 104         } else {
 105                 head_ptr = mwifiex_process_sta_txpd(priv, skb);
 106         }
 107
 108         if ((adapter->data_sent || adapter->tx_lock_flag) && head_ptr) {
 109                 skb_queue_tail(&adapter->tx_data_q, skb);
 110                 atomic_inc(&adapter->tx_queued);
 111                 return 0;
 112         }
 113
 114         if (head_ptr) {
 115                 if (GET_BSS_ROLE(priv) == MWIFIEX_BSS_ROLE_STA)
 116                         local_tx_pd = (struct txpd *)(head_ptr + hroom);
 117                 if (adapter->iface_type == MWIFIEX_USB) {
 118                         ret = adapter->if_ops.host_to_card(adapter,
 119                                                            priv->usb_port,
 120                                                            skb, tx_param);
 121                 } else {
 122                         ret = adapter->if_ops.host_to_card(adapter,
 123                                                            MWIFIEX_TYPE_DATA,
 124                                                            skb, tx_param);
 125                 }
 126         }
 127         mwifiex_dbg_dump(adapter, DAT_D, "tx pkt:", skb->data,
 128                          min_t(size_t, skb->len, DEBUG_DUMP_DATA_MAX_LEN));
 129
 130         switch (ret) {
 131         case -ENOSR:
 132                 mwifiex_dbg(adapter, DATA, "data: -ENOSR is returned\n");
 133                 break;
 134         case -EBUSY:
 135                 if ((GET_BSS_ROLE(priv) == MWIFIEX_BSS_ROLE_STA) &&
 136                     (adapter->pps_uapsd_mode) && (adapter->tx_lock_flag)) {
 137                                 priv->adapter->tx_lock_flag = false;
 138                                 if (local_tx_pd)
 139                                         local_tx_pd->flags = 0;
 140                 }
 141                 mwifiex_dbg(adapter, ERROR, "data: -EBUSY is returned\n");
 142                 break;
 143         case -1:
 144                 mwifiex_dbg(adapter, ERROR,
 145                             "mwifiex_write_data_async failed: 0x%X\n",
 146                             ret);
 147                 adapter->dbg.num_tx_host_to_card_failure++;
 148                 mwifiex_write_data_complete(adapter, skb, 0, ret);
 149                 break;
 150         case -EINPROGRESS:
 151                 break;
 152         case 0:
 153                 mwifiex_write_data_complete(adapter, skb, 0, ret);
 154                 break;
 155         default:
 156                 break;
 157         }
 158
 159         return ret;
 160 }
 161
 162 static int mwifiex_host_to_card(struct mwifiex_adapter *adapter,
 163                                 struct sk_buff *skb,
 164                                 struct mwifiex_tx_param *tx_param)
 165 {
 166         struct txpd *local_tx_pd = NULL;
 167         u8 *head_ptr = skb->data;
 168         int ret = 0;
 169         struct mwifiex_private *priv;
 170         struct mwifiex_txinfo *tx_info;
 171
 172         tx_info = MWIFIEX_SKB_TXCB(skb);
 173         priv = mwifiex_get_priv_by_id(adapter, tx_info->bss_num,
 174                                       tx_info->bss_type);
 175         if (!priv) {
 176                 mwifiex_dbg(adapter, ERROR,
 177                             "data: priv not found. Drop TX packet\n");
 178                 adapter->dbg.num_tx_host_to_card_failure++;
 179                 mwifiex_write_data_complete(adapter, skb, 0, 0);
 180                 return ret;
 181         }
 182         if (GET_BSS_ROLE(priv) == MWIFIEX_BSS_ROLE_STA)
 183                 local_tx_pd = (struct txpd *)(head_ptr + adapter->intf_hdr_len);
 184
 185         if (adapter->iface_type == MWIFIEX_USB) {
 186                 ret = adapter->if_ops.host_to_card(adapter,
 187                                                    priv->usb_port,
 188                                                    skb, tx_param);
 189         } else {
 190                 ret = adapter->if_ops.host_to_card(adapter,
 191                                                    MWIFIEX_TYPE_DATA,
 192                                                    skb, tx_param);
 193         }
 194         switch (ret) {
 195         case -ENOSR:
 196                 mwifiex_dbg(adapter, ERROR, "data: -ENOSR is returned\n");
 197                 break;
 198         case -EBUSY:
 199                 if ((GET_BSS_ROLE(priv) == MWIFIEX_BSS_ROLE_STA) &&
 200                     (adapter->pps_uapsd_mode) &&
 201                     (adapter->tx_lock_flag)) {
 202                         priv->adapter->tx_lock_flag = false;
 203                         if (local_tx_pd)
 204                                 local_tx_pd->flags = 0;
 205                 }
 206                 skb_queue_head(&adapter->tx_data_q, skb);
 207                 if (tx_info->flags & MWIFIEX_BUF_FLAG_AGGR_PKT)
 208                         atomic_add(tx_info->aggr_num, &adapter->tx_queued);
 209                 else
 210                         atomic_inc(&adapter->tx_queued);
 211                 mwifiex_dbg(adapter, ERROR, "data: -EBUSY is returned\n");
 212                 break;
 213         case -1:
 214                 mwifiex_dbg(adapter, ERROR,
 215                             "mwifiex_write_data_async failed: 0x%X\n", ret);
 216                 adapter->dbg.num_tx_host_to_card_failure++;
 217                 mwifiex_write_data_complete(adapter, skb, 0, ret);
 218                 break;
 219         case -EINPROGRESS:
 220                 break;
 221         case 0:
 222                 mwifiex_write_data_complete(adapter, skb, 0, ret);
 223                 break;
 224         default:
 225                 break;
 226         }
 227         return ret;
 228 }
 229
 230 static int
 231 mwifiex_dequeue_tx_queue(struct mwifiex_adapter *adapter)
 232 {
 233         struct sk_buff *skb, *skb_next;
 234         struct mwifiex_txinfo *tx_info;
 235         struct mwifiex_tx_param tx_param;
 236
 237         skb = skb_dequeue(&adapter->tx_data_q);
 238         if (!skb)
 239                 return -1;
 240
 241         tx_info = MWIFIEX_SKB_TXCB(skb);
 242         if (tx_info->flags & MWIFIEX_BUF_FLAG_AGGR_PKT)
 243                 atomic_sub(tx_info->aggr_num, &adapter->tx_queued);
 244         else
 245                 atomic_dec(&adapter->tx_queued);
 246
 247         if (!skb_queue_empty(&adapter->tx_data_q))
 248                 skb_next = skb_peek(&adapter->tx_data_q);
 249         else
 250                 skb_next = NULL;
 251         tx_param.next_pkt_len = ((skb_next) ? skb_next->len : 0);
 252         if (!tx_param.next_pkt_len) {
 253                 if (!mwifiex_wmm_lists_empty(adapter))
 254                         tx_param.next_pkt_len = 1;
 255         }
 256         return mwifiex_host_to_card(adapter, skb, &tx_param);
 257 }
 258
 259 void
 260 mwifiex_process_tx_queue(struct mwifiex_adapter *adapter)
 261 {
 262         do {
 263                 if (adapter->data_sent || adapter->tx_lock_flag)
 264                         break;
 265                 if (mwifiex_dequeue_tx_queue(adapter))
 266                         break;
 267         } while (!skb_queue_empty(&adapter->tx_data_q));
 268 }
 269
 270 /*
 271  * Packet send completion callback handler.
 272  *
 273  * It either frees the buffer directly or forwards it to another
 274  * completion callback which checks conditions, updates statistics,
 275  * wakes up stalled traffic queue if required, and then frees the buffer.
 276  */
 277 int mwifiex_write_data_complete(struct mwifiex_adapter *adapter,
 278                                 struct sk_buff *skb, int aggr, int status)
 279 {
 280         struct mwifiex_private *priv;
 281         struct mwifiex_txinfo *tx_info;
 282         struct netdev_queue *txq;
 283         int index;
 284
 285         if (!skb)
 286                 return 0;
 287
 288         tx_info = MWIFIEX_SKB_TXCB(skb);
 289         priv = mwifiex_get_priv_by_id(adapter, tx_info->bss_num,
 290                                       tx_info->bss_type);
 291         if (!priv)
 292                 goto done;
 293
 294         mwifiex_set_trans_start(priv->netdev);
 295
 296         if (tx_info->flags & MWIFIEX_BUF_FLAG_BRIDGED_PKT)
 297                 atomic_dec_return(&adapter->pending_bridged_pkts);
 298
 299         if (tx_info->flags & MWIFIEX_BUF_FLAG_AGGR_PKT)
 300                 goto done;
 301
 302         if (!status) {
 303                 priv->stats.tx_packets++;
 304                 priv->stats.tx_bytes += tx_info->pkt_len;
 305                 if (priv->tx_timeout_cnt)
 306                         priv->tx_timeout_cnt = 0;
 307         } else {
 308                 priv->stats.tx_errors++;
 309         }
 310
 311         if (aggr)
 312                 /* For skb_aggr, do not wake up tx queue */
 313                 goto done;
 314
 315         atomic_dec(&adapter->tx_pending);
 316
 317         index = mwifiex_1d_to_wmm_queue[skb->priority];
 318         if (atomic_dec_return(&priv->wmm_tx_pending[index]) < LOW_TX_PENDING) {
 319                 txq = netdev_get_tx_queue(priv->netdev, index);
 320                 if (netif_tx_queue_stopped(txq)) {
 321                         netif_tx_wake_queue(txq);
 322                         mwifiex_dbg(adapter, DATA, "wake queue: %d\n", index);
 323                 }
 324         }
 325 done:
 326         dev_kfree_skb_any(skb);
 327
 328         return 0;
 329 }
 330 EXPORT_SYMBOL_GPL(mwifiex_write_data_complete);
 331
 332 void mwifiex_parse_tx_status_event(struct mwifiex_private *priv,
 333                                    void *event_body)
 334 {
 335         struct tx_status_event *tx_status = (void *)priv->adapter->event_body;
 336         struct sk_buff *ack_skb;
 337         struct mwifiex_txinfo *tx_info;
 338
 339         if (!tx_status->tx_token_id)
 340                 return;
 341
 342         spin_lock_bh(&priv->ack_status_lock);
 343         ack_skb = idr_remove(&priv->ack_status_frames, tx_status->tx_token_id);
 344         spin_unlock_bh(&priv->ack_status_lock);
 345
 346         if (ack_skb) {
 347                 tx_info = MWIFIEX_SKB_TXCB(ack_skb);
 348
 349                 if (tx_info->flags & MWIFIEX_BUF_FLAG_EAPOL_TX_STATUS) {
 350                         /* consumes ack_skb */
 351                         skb_complete_wifi_ack(ack_skb, !tx_status->status);
 352                 } else {
 353                         /* Remove broadcast address which was added by driver */
 354                         memmove(ack_skb->data +
 355                                 sizeof(struct ieee80211_hdr_3addr) +
 356                                 MWIFIEX_MGMT_FRAME_HEADER_SIZE + sizeof(u16),
 357                                 ack_skb->data +
 358                                 sizeof(struct ieee80211_hdr_3addr) +
 359                                 MWIFIEX_MGMT_FRAME_HEADER_SIZE + sizeof(u16) +
 360                                 ETH_ALEN, ack_skb->len -
 361                                 (sizeof(struct ieee80211_hdr_3addr) +
 362                                 MWIFIEX_MGMT_FRAME_HEADER_SIZE + sizeof(u16) +
 363                                 ETH_ALEN));
 364                         ack_skb->len = ack_skb->len - ETH_ALEN;
 365                         /* Remove driver's proprietary header including 2 bytes
 366                          * of packet length and pass actual management frame buffer
 367                          * to cfg80211.
 368                          */
 369                         cfg80211_mgmt_tx_status(&priv->wdev, tx_info->cookie,
 370                                                 ack_skb->data +
 371                                                 MWIFIEX_MGMT_FRAME_HEADER_SIZE +
 372                                                 sizeof(u16), ack_skb->len -
 373                                                 (MWIFIEX_MGMT_FRAME_HEADER_SIZE
 374                                                  + sizeof(u16)),
 375                                                 !tx_status->status, GFP_ATOMIC);
 376                         dev_kfree_skb_any(ack_skb);
 377                 }
 378         }
 379 }