| 1 |
// SPDX-License-Identifier: GPL-2.0-only |
| 2 |
/* |
| 3 |
* NXP Wireless LAN device driver: station TX data handling |
| 4 |
* |
| 5 |
* Copyright 2011-2020 NXP |
| 6 |
*/ |
| 7 |
|
| 8 |
#include "decl.h" |
| 9 |
#include "ioctl.h" |
| 10 |
#include "util.h" |
| 11 |
#include "fw.h" |
| 12 |
#include "main.h" |
| 13 |
#include "wmm.h" |
| 14 |
|
| 15 |
/* |
| 16 |
* This function fills the TxPD for tx packets. |
| 17 |
* |
| 18 |
* The Tx buffer received by this function should already have the |
| 19 |
* header space allocated for TxPD. |
| 20 |
* |
| 21 |
* This function inserts the TxPD in between interface header and actual |
| 22 |
* data and adjusts the buffer pointers accordingly. |
| 23 |
* |
| 24 |
* The following TxPD fields are set by this function, as required - |
| 25 |
* - BSS number |
| 26 |
* - Tx packet length and offset |
| 27 |
* - Priority |
| 28 |
* - Packet delay |
| 29 |
* - Priority specific Tx control |
| 30 |
* - Flags |
| 31 |
*/ |
| 32 |
void mwifiex_process_sta_txpd(struct mwifiex_private *priv, |
| 33 |
struct sk_buff *skb) |
| 34 |
{ |
| 35 |
struct mwifiex_adapter *adapter = priv->adapter; |
| 36 |
struct txpd *local_tx_pd; |
| 37 |
struct mwifiex_txinfo *tx_info = MWIFIEX_SKB_TXCB(skb); |
| 38 |
unsigned int pad; |
| 39 |
u16 pkt_type, pkt_length, pkt_offset; |
| 40 |
int hroom = adapter->intf_hdr_len; |
| 41 |
|
| 42 |
pkt_type = mwifiex_is_skb_mgmt_frame(skb) ? PKT_TYPE_MGMT : 0; |
| 43 |
|
| 44 |
pad = ((uintptr_t)skb->data - (sizeof(*local_tx_pd) + hroom)) & |
| 45 |
(MWIFIEX_DMA_ALIGN_SZ - 1); |
| 46 |
skb_push(skb, sizeof(*local_tx_pd) + pad); |
| 47 |
|
| 48 |
local_tx_pd = (struct txpd *) skb->data; |
| 49 |
memset(local_tx_pd, 0, sizeof(struct txpd)); |
| 50 |
local_tx_pd->bss_num = priv->bss_num; |
| 51 |
local_tx_pd->bss_type = priv->bss_type; |
| 52 |
pkt_length = (u16)(skb->len - (sizeof(struct txpd) + pad)); |
| 53 |
if (pkt_type == PKT_TYPE_MGMT) |
| 54 |
pkt_length -= MWIFIEX_MGMT_FRAME_HEADER_SIZE; |
| 55 |
local_tx_pd->tx_pkt_length = cpu_to_le16(pkt_length); |
| 56 |
|
| 57 |
local_tx_pd->priority = (u8) skb->priority; |
| 58 |
local_tx_pd->pkt_delay_2ms = |
| 59 |
mwifiex_wmm_compute_drv_pkt_delay(priv, skb); |
| 60 |
|
| 61 |
if (tx_info->flags & MWIFIEX_BUF_FLAG_EAPOL_TX_STATUS || |
| 62 |
tx_info->flags & MWIFIEX_BUF_FLAG_ACTION_TX_STATUS) { |
| 63 |
local_tx_pd->tx_token_id = tx_info->ack_frame_id; |
| 64 |
local_tx_pd->flags |= MWIFIEX_TXPD_FLAGS_REQ_TX_STATUS; |
| 65 |
} |
| 66 |
|
| 67 |
if (local_tx_pd->priority < |
| 68 |
ARRAY_SIZE(priv->wmm.user_pri_pkt_tx_ctrl)) |
| 69 |
/* |
| 70 |
* Set the priority specific tx_control field, setting of 0 will |
| 71 |
* cause the default value to be used later in this function |
| 72 |
*/ |
| 73 |
local_tx_pd->tx_control = |
| 74 |
cpu_to_le32(priv->wmm.user_pri_pkt_tx_ctrl[local_tx_pd-> |
| 75 |
priority]); |
| 76 |
|
| 77 |
if (adapter->pps_uapsd_mode) { |
| 78 |
if (mwifiex_check_last_packet_indication(priv)) { |
| 79 |
adapter->tx_lock_flag = true; |
| 80 |
local_tx_pd->flags = |
| 81 |
MWIFIEX_TxPD_POWER_MGMT_LAST_PACKET; |
| 82 |
} |
| 83 |
} |
| 84 |
|
| 85 |
if (tx_info->flags & MWIFIEX_BUF_FLAG_TDLS_PKT) |
| 86 |
local_tx_pd->flags |= MWIFIEX_TXPD_FLAGS_TDLS_PACKET; |
| 87 |
|
| 88 |
/* Offset of actual data */ |
| 89 |
pkt_offset = sizeof(struct txpd) + pad; |
| 90 |
if (pkt_type == PKT_TYPE_MGMT) { |
| 91 |
/* Set the packet type and add header for management frame */ |
| 92 |
local_tx_pd->tx_pkt_type = cpu_to_le16(pkt_type); |
| 93 |
pkt_offset += MWIFIEX_MGMT_FRAME_HEADER_SIZE; |
| 94 |
} |
| 95 |
|
| 96 |
local_tx_pd->tx_pkt_offset = cpu_to_le16(pkt_offset); |
| 97 |
|
| 98 |
/* make space for adapter->intf_hdr_len */ |
| 99 |
skb_push(skb, hroom); |
| 100 |
|
| 101 |
if (!local_tx_pd->tx_control) |
| 102 |
/* TxCtrl set by user or default */ |
| 103 |
local_tx_pd->tx_control = cpu_to_le32(priv->pkt_tx_ctrl); |
| 104 |
} |
| 105 |
|
| 106 |
/* |
| 107 |
* This function tells firmware to send a NULL data packet. |
| 108 |
* |
| 109 |
* The function creates a NULL data packet with TxPD and sends to the |
| 110 |
* firmware for transmission, with highest priority setting. |
| 111 |
*/ |
| 112 |
int mwifiex_send_null_packet(struct mwifiex_private *priv, u8 flags) |
| 113 |
{ |
| 114 |
struct mwifiex_adapter *adapter = priv->adapter; |
| 115 |
struct txpd *local_tx_pd; |
| 116 |
struct mwifiex_tx_param tx_param; |
| 117 |
/* sizeof(struct txpd) + Interface specific header */ |
| 118 |
#define NULL_PACKET_HDR 64 |
| 119 |
u32 data_len = NULL_PACKET_HDR; |
| 120 |
struct sk_buff *skb; |
| 121 |
int ret; |
| 122 |
struct mwifiex_txinfo *tx_info = NULL; |
| 123 |
|
| 124 |
if (test_bit(MWIFIEX_SURPRISE_REMOVED, &adapter->work_flags)) |
| 125 |
return -1; |
| 126 |
|
| 127 |
if (!priv->media_connected) |
| 128 |
return -1; |
| 129 |
|
| 130 |
if (adapter->data_sent) |
| 131 |
return -1; |
| 132 |
|
| 133 |
if (adapter->if_ops.is_port_ready && |
| 134 |
!adapter->if_ops.is_port_ready(priv)) |
| 135 |
return -1; |
| 136 |
|
| 137 |
skb = dev_alloc_skb(data_len); |
| 138 |
if (!skb) |
| 139 |
return -1; |
| 140 |
|
| 141 |
tx_info = MWIFIEX_SKB_TXCB(skb); |
| 142 |
memset(tx_info, 0, sizeof(*tx_info)); |
| 143 |
tx_info->bss_num = priv->bss_num; |
| 144 |
tx_info->bss_type = priv->bss_type; |
| 145 |
tx_info->pkt_len = data_len - |
| 146 |
(sizeof(struct txpd) + adapter->intf_hdr_len); |
| 147 |
skb_reserve(skb, sizeof(struct txpd) + adapter->intf_hdr_len); |
| 148 |
skb_push(skb, sizeof(struct txpd)); |
| 149 |
|
| 150 |
local_tx_pd = (struct txpd *) skb->data; |
| 151 |
local_tx_pd->tx_control = cpu_to_le32(priv->pkt_tx_ctrl); |
| 152 |
local_tx_pd->flags = flags; |
| 153 |
local_tx_pd->priority = WMM_HIGHEST_PRIORITY; |
| 154 |
local_tx_pd->tx_pkt_offset = cpu_to_le16(sizeof(struct txpd)); |
| 155 |
local_tx_pd->bss_num = priv->bss_num; |
| 156 |
local_tx_pd->bss_type = priv->bss_type; |
| 157 |
|
| 158 |
skb_push(skb, adapter->intf_hdr_len); |
| 159 |
if (adapter->iface_type == MWIFIEX_USB) { |
| 160 |
ret = adapter->if_ops.host_to_card(adapter, priv->usb_port, |
| 161 |
skb, NULL); |
| 162 |
} else { |
| 163 |
tx_param.next_pkt_len = 0; |
| 164 |
ret = adapter->if_ops.host_to_card(adapter, MWIFIEX_TYPE_DATA, |
| 165 |
skb, &tx_param); |
| 166 |
} |
| 167 |
switch (ret) { |
| 168 |
case -EBUSY: |
| 169 |
dev_kfree_skb_any(skb); |
| 170 |
mwifiex_dbg(adapter, ERROR, |
| 171 |
"%s: host_to_card failed: ret=%d\n", |
| 172 |
__func__, ret); |
| 173 |
adapter->dbg.num_tx_host_to_card_failure++; |
| 174 |
break; |
| 175 |
case -1: |
| 176 |
dev_kfree_skb_any(skb); |
| 177 |
mwifiex_dbg(adapter, ERROR, |
| 178 |
"%s: host_to_card failed: ret=%d\n", |
| 179 |
__func__, ret); |
| 180 |
adapter->dbg.num_tx_host_to_card_failure++; |
| 181 |
break; |
| 182 |
case 0: |
| 183 |
dev_kfree_skb_any(skb); |
| 184 |
mwifiex_dbg(adapter, DATA, |
| 185 |
"data: %s: host_to_card succeeded\n", |
| 186 |
__func__); |
| 187 |
adapter->tx_lock_flag = true; |
| 188 |
break; |
| 189 |
case -EINPROGRESS: |
| 190 |
adapter->tx_lock_flag = true; |
| 191 |
break; |
| 192 |
default: |
| 193 |
break; |
| 194 |
} |
| 195 |
|
| 196 |
return ret; |
| 197 |
} |
| 198 |
|
| 199 |
/* |
| 200 |
* This function checks if we need to send last packet indication. |
| 201 |
*/ |
| 202 |
u8 |
| 203 |
mwifiex_check_last_packet_indication(struct mwifiex_private *priv) |
| 204 |
{ |
| 205 |
struct mwifiex_adapter *adapter = priv->adapter; |
| 206 |
u8 ret = false; |
| 207 |
|
| 208 |
if (!adapter->sleep_period.period) |
| 209 |
return ret; |
| 210 |
if (mwifiex_wmm_lists_empty(adapter)) |
| 211 |
ret = true; |
| 212 |
|
| 213 |
if (ret && !adapter->cmd_sent && !adapter->curr_cmd && |
| 214 |
!is_command_pending(adapter)) { |
| 215 |
adapter->delay_null_pkt = false; |
| 216 |
ret = true; |
| 217 |
} else { |
| 218 |
ret = false; |
| 219 |
adapter->delay_null_pkt = true; |
| 220 |
} |
| 221 |
return ret; |
| 222 |
} |