kernel/drivers/net/wireless/rsi/rsi_91x_pkt.c

   1 /**
   2  * Copyright (c) 2014 Redpine Signals Inc.
   3  *
   4  * Permission to use, copy, modify, and/or distribute this software for any
   5  * purpose with or without fee is hereby granted, provided that the above
   6  * copyright notice and this permission notice appear in all copies.
   7  *
   8  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
   9  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
  10  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
  11  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
  12  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
  13  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
  14  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  15  */
  16
  17 #include "rsi_mgmt.h"
  18
  19 /**
  20  * rsi_send_data_pkt() - This function sends the recieved data packet from
  21  *                       driver to device.
  22  * @common: Pointer to the driver private structure.
  23  * @skb: Pointer to the socket buffer structure.
  24  *
  25  * Return: status: 0 on success, -1 on failure.
  26  */
  27 int rsi_send_data_pkt(struct rsi_common *common, struct sk_buff *skb)
  28 {
  29         struct rsi_hw *adapter = common->priv;
  30         struct ieee80211_hdr *tmp_hdr = NULL;
  31         struct ieee80211_tx_info *info;
  32         struct skb_info *tx_params;
  33         struct ieee80211_bss_conf *bss = NULL;
  34         int status = -EINVAL;
  35         u8 ieee80211_size = MIN_802_11_HDR_LEN;
  36         u8 extnd_size = 0;
  37         __le16 *frame_desc;
  38         u16 seq_num = 0;
  39
  40         info = IEEE80211_SKB_CB(skb);
  41         bss = &info->control.vif->bss_conf;
  42         tx_params = (struct skb_info *)info->driver_data;
  43
  44         if (!bss->assoc)
  45                 goto err;
  46
  47         tmp_hdr = (struct ieee80211_hdr *)&skb->data[0];
  48         seq_num = (le16_to_cpu(tmp_hdr->seq_ctrl) >> 4);
  49
  50         extnd_size = ((uintptr_t)skb->data & 0x3);
  51
  52         if ((FRAME_DESC_SZ + extnd_size) > skb_headroom(skb)) {
  53                 rsi_dbg(ERR_ZONE, "%s: Unable to send pkt\n", __func__);
  54                 status = -ENOSPC;
  55                 goto err;
  56         }
  57
  58         skb_push(skb, (FRAME_DESC_SZ + extnd_size));
  59         frame_desc = (__le16 *)&skb->data[0];
  60         memset((u8 *)frame_desc, 0, FRAME_DESC_SZ);
  61
  62         if (ieee80211_is_data_qos(tmp_hdr->frame_control)) {
  63                 ieee80211_size += 2;
  64                 frame_desc[6] |= cpu_to_le16(BIT(12));
  65         }
  66
  67         if ((!(info->flags & IEEE80211_TX_INTFL_DONT_ENCRYPT)) &&
  68             (common->secinfo.security_enable)) {
  69                 if (rsi_is_cipher_wep(common))
  70                         ieee80211_size += 4;
  71                 else
  72                         ieee80211_size += 8;
  73                 frame_desc[6] |= cpu_to_le16(BIT(15));
  74         }
  75
  76         frame_desc[0] = cpu_to_le16((skb->len - FRAME_DESC_SZ) |
  77                                     (RSI_WIFI_DATA_Q << 12));
  78         frame_desc[2] = cpu_to_le16((extnd_size) | (ieee80211_size) << 8);
  79
  80         if (common->min_rate != 0xffff) {
  81                 /* Send fixed rate */
  82                 frame_desc[3] = cpu_to_le16(RATE_INFO_ENABLE);
  83                 frame_desc[4] = cpu_to_le16(common->min_rate);
  84
  85                 if (conf_is_ht40(&common->priv->hw->conf))
  86                         frame_desc[5] = cpu_to_le16(FULL40M_ENABLE);
  87
  88                 if (common->vif_info[0].sgi) {
  89                         if (common->min_rate & 0x100) /* Only MCS rates */
  90                                 frame_desc[4] |=
  91                                         cpu_to_le16(ENABLE_SHORTGI_RATE);
  92                 }
  93
  94         }
  95
  96         frame_desc[6] |= cpu_to_le16(seq_num & 0xfff);
  97         frame_desc[7] = cpu_to_le16(((tx_params->tid & 0xf) << 4) |
  98                                     (skb->priority & 0xf) |
  99                                     (tx_params->sta_id << 8));
 100
 101         status = adapter->host_intf_write_pkt(common->priv,
 102                                               skb->data,
 103                                               skb->len);
 104         if (status)
 105                 rsi_dbg(ERR_ZONE, "%s: Failed to write pkt\n",
 106                         __func__);
 107
 108 err:
 109         ++common->tx_stats.total_tx_pkt_freed[skb->priority];
 110         rsi_indicate_tx_status(common->priv, skb, status);
 111         return status;
 112 }
 113
 114 /**
 115  * rsi_send_mgmt_pkt() - This functions sends the received management packet
 116  *                       from driver to device.
 117  * @common: Pointer to the driver private structure.
 118  * @skb: Pointer to the socket buffer structure.
 119  *
 120  * Return: status: 0 on success, -1 on failure.
 121  */
 122 int rsi_send_mgmt_pkt(struct rsi_common *common,
 123                       struct sk_buff *skb)
 124 {
 125         struct rsi_hw *adapter = common->priv;
 126         struct ieee80211_hdr *wh = NULL;
 127         struct ieee80211_tx_info *info;
 128         struct ieee80211_bss_conf *bss = NULL;
 129         struct ieee80211_hw *hw = adapter->hw;
 130         struct ieee80211_conf *conf = &hw->conf;
 131         struct skb_info *tx_params;
 132         int status = -E2BIG;
 133         __le16 *msg = NULL;
 134         u8 extnd_size = 0;
 135         u8 vap_id = 0;
 136
 137         info = IEEE80211_SKB_CB(skb);
 138         tx_params = (struct skb_info *)info->driver_data;
 139         extnd_size = ((uintptr_t)skb->data & 0x3);
 140
 141         if (tx_params->flags & INTERNAL_MGMT_PKT) {
 142                 if ((extnd_size) > skb_headroom(skb)) {
 143                         rsi_dbg(ERR_ZONE, "%s: Unable to send pkt\n", __func__);
 144                         dev_kfree_skb(skb);
 145                         return -ENOSPC;
 146                 }
 147                 skb_push(skb, extnd_size);
 148                 skb->data[extnd_size + 4] = extnd_size;
 149                 status = adapter->host_intf_write_pkt(common->priv,
 150                                                       (u8 *)skb->data,
 151                                                       skb->len);
 152                 if (status) {
 153                         rsi_dbg(ERR_ZONE,
 154                                 "%s: Failed to write the packet\n", __func__);
 155                 }
 156                 dev_kfree_skb(skb);
 157                 return status;
 158         }
 159
 160         bss = &info->control.vif->bss_conf;
 161         wh = (struct ieee80211_hdr *)&skb->data[0];
 162
 163         if (FRAME_DESC_SZ > skb_headroom(skb))
 164                 goto err;
 165
 166         skb_push(skb, FRAME_DESC_SZ);
 167         memset(skb->data, 0, FRAME_DESC_SZ);
 168         msg = (__le16 *)skb->data;
 169
 170         if (skb->len > MAX_MGMT_PKT_SIZE) {
 171                 rsi_dbg(INFO_ZONE, "%s: Dropping mgmt pkt > 512\n", __func__);
 172                 goto err;
 173         }
 174
 175         msg[0] = cpu_to_le16((skb->len - FRAME_DESC_SZ) |
 176                             (RSI_WIFI_MGMT_Q << 12));
 177         msg[1] = cpu_to_le16(TX_DOT11_MGMT);
 178         msg[2] = cpu_to_le16(MIN_802_11_HDR_LEN << 8);
 179         msg[3] = cpu_to_le16(RATE_INFO_ENABLE);
 180         msg[6] = cpu_to_le16(le16_to_cpu(wh->seq_ctrl) >> 4);
 181
 182         if (wh->addr1[0] & BIT(0))
 183                 msg[3] |= cpu_to_le16(RSI_BROADCAST_PKT);
 184
 185         if (common->band == IEEE80211_BAND_2GHZ)
 186                 msg[4] = cpu_to_le16(RSI_11B_MODE);
 187         else
 188                 msg[4] = cpu_to_le16((RSI_RATE_6 & 0x0f) | RSI_11G_MODE);
 189
 190         if (conf_is_ht40(conf)) {
 191                 msg[4] = cpu_to_le16(0xB | RSI_11G_MODE);
 192                 msg[5] = cpu_to_le16(0x6);
 193         }
 194
 195         /* Indicate to firmware to give cfm */
 196         if ((skb->data[16] == IEEE80211_STYPE_PROBE_REQ) && (!bss->assoc)) {
 197                 msg[1] |= cpu_to_le16(BIT(10));
 198                 msg[7] = cpu_to_le16(PROBEREQ_CONFIRM);
 199                 common->mgmt_q_block = true;
 200         }
 201
 202         msg[7] |= cpu_to_le16(vap_id << 8);
 203
 204         status = adapter->host_intf_write_pkt(common->priv,
 205                                               (u8 *)msg,
 206                                               skb->len);
 207         if (status)
 208                 rsi_dbg(ERR_ZONE, "%s: Failed to write the packet\n", __func__);
 209
 210 err:
 211         rsi_indicate_tx_status(common->priv, skb, status);
 212         return status;
 213 }