From: Jahnavi Meher <[email protected]>
This patch has the functions which send the packets to be
written onto the device.
Signed-off-by: Jahnavi Meher <[email protected]>
---
rsi_91x_pkt.c | 231 ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
1 file changed, 231 insertions(+)
diff -uprN a/drivers/net/wireless/rsi/91x/rsi_91x_pkt.c b/drivers/net/wireless/rsi/91x/rsi_91x_pkt.c
--- a/drivers/net/wireless/rsi/91x/rsi_91x_pkt.c 1970-01-01 05:30:00.000000000 +0530
+++ b/drivers/net/wireless/rsi/91x/rsi_91x_pkt.c 2014-01-30 16:25:56.129903584 +0530
@@ -0,0 +1,231 @@
+/**
+ * @file rsi_91x_pkt.c
+ * @author
+ * @version 1.0
+ *
+ * @section LICENSE
+ * Copyright (c) 2013 Redpine Signals Inc.
+ *
+ * Permission to use, copy, modify, and/or distribute this software for any
+ * purpose with or without fee is hereby granted, provided that the above
+ * copyright notice and this permission notice appear in all copies.
+ *
+ * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
+ * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
+ * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
+ * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
+ * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
+ * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
+ * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
+ *
+ * @section DESCRIPTION
+ *
+ * The file handles the data/mgmt packets transfer to the device.
+ */
+
+#include "../include/rsi_main.h"
+#include "../include/rsi_device_ops.h"
+#include "../include/rsi_mgmt.h"
+
+/**
+ * This function sends the recieved data packet from driver to onair.
+ *
+ * @param common Pointer to the driver private structure.
+ * @param skb Pointer to the socket buffer structure.
+ * @return status: 0 on success, -1 on failure.
+ */
+int rsi_send_data_pkt(struct rsi_common *common,
+ struct sk_buff *skb)
+{
+ unsigned short *frame_desc;
+ unsigned short seq_num = 0;
+ struct ieee80211_hdr *tmp_hdr = NULL;
+ unsigned char ieee80211_size = MIN_802_11_HDR_LEN;
+ unsigned char extnd_size = 0;
+ struct ieee80211_tx_info *info;
+ struct skb_info *tx_params;
+ struct ieee80211_bss_conf *bss = NULL;
+ int status = -1;
+
+ info = IEEE80211_SKB_CB(skb);
+ bss = &info->control.vif->bss_conf;
+ tx_params = (struct skb_info *)info->driver_data;
+
+ if ((common->fsm_state != FSM_MAC_INIT_DONE) || (!bss->assoc))
+ goto err;
+
+ tmp_hdr = (struct ieee80211_hdr *)&skb->data[0];
+ seq_num = (tmp_hdr->seq_ctrl >> 4);
+
+ extnd_size = ((uintptr_t)skb->data & 0x3);
+
+ if ((FRAME_DESC_SZ + extnd_size) > skb_headroom(skb)) {
+ rsi_dbg(ERR_ZONE, "%s: Unable to send pkt\n", __func__);
+ goto err;
+ } else {
+ skb_push(skb, (FRAME_DESC_SZ + extnd_size));
+ }
+
+ frame_desc = (unsigned short *)&skb->data[0];
+ memset((unsigned char *)frame_desc, 0, FRAME_DESC_SZ);
+
+ if (tmp_hdr->frame_control & IEEE80211_QOS_ENABLED) {
+ ieee80211_size += 2;
+ frame_desc[6] |= cpu_to_le16(BIT(12));
+ }
+
+ if ((!(info->flags & IEEE80211_TX_INTFL_DONT_ENCRYPT)) &&
+ (common->secinfo.security_enable)) {
+ if (rsi_is_cipher_wep(common))
+ ieee80211_size += 4;
+ else
+ ieee80211_size += 8;
+ frame_desc[6] |= cpu_to_le16(BIT(15));
+ }
+
+ frame_desc[0] = cpu_to_le16((skb->len - FRAME_DESC_SZ) |
+ (RSI_WIFI_DATA_Q << 12));
+ frame_desc[2] = cpu_to_le16((extnd_size) | (ieee80211_size) << 8);
+
+ if (common->min_rate != 0xffff) {
+ /* Send fixed rate */
+ frame_desc[3] = cpu_to_le16(RATE_INFO_ENABLE);
+ frame_desc[4] = cpu_to_le16(common->min_rate);
+ }
+
+ frame_desc[6] |= cpu_to_le16(seq_num & 0xfff);
+ frame_desc[7] = cpu_to_le16(((tx_params->tid & 0xf) << 4) |
+ (skb->priority & 0xf) |
+ (tx_params->sta_id << 8));
+
+ common->common_ops->print(DATA_TX_ZONE, skb->data, skb->len);
+ if (skb->len <= 1594) {
+ status = common->common_ops->host_intf_write_pkt(common->priv,
+ skb->data,
+ skb->len);
+ if (status) {
+ rsi_dbg(ERR_ZONE, "%s: Failed to write pkt\n",
+ __func__);
+ }
+ }
+
+err:
+ ++common->tx_stats.total_data_pkt_freed[skb->priority];
+ rsi_indicate_tx_status(common->priv, skb, status);
+ return status;
+}
+EXPORT_SYMBOL(rsi_send_data_pkt);
+
+/**
+ * This functions sends the recieved management packet from driver to onair.
+ *
+ * @param common Pointer to the driver private structure.
+ * @param skb Pointer to the socket buffer structure.
+ * @return status: 0 on success, -1 on failure.
+ */
+int rsi_send_mgmt_pkt(struct rsi_common *common,
+ struct sk_buff *skb)
+{
+ unsigned short *msg = NULL;
+ unsigned char vap_id = 0;
+ struct ieee80211_hdr *wh = NULL;
+ unsigned char extnd_size = 0;
+ struct ieee80211_tx_info *info;
+ struct ieee80211_bss_conf *bss = NULL;
+ struct skb_info *tx_params;
+ int status = -1;
+
+ info = IEEE80211_SKB_CB(skb);
+ tx_params = (struct skb_info *)info->driver_data;
+ extnd_size = ((uintptr_t)skb->data & 0x3);
+
+ if (tx_params->flags & INTERNAL_MGMT_PKT) {
+ if ((extnd_size) > skb_headroom(skb)) {
+ rsi_dbg(ERR_ZONE, "%s: Unable to send pkt\n",
+ __func__);
+ dev_kfree_skb(skb);
+ return -1;
+ } else {
+ skb_push(skb, extnd_size);
+ }
+ skb->data[extnd_size + 4] = cpu_to_le16(extnd_size);
+ common->common_ops->print(MGMT_TX_ZONE,
+ (unsigned char *)skb->data,
+ skb->len);
+ status = common->common_ops->host_intf_write_pkt(common->priv,
+ (unsigned char *)skb->data,
+ skb->len);
+ if (status) {
+ rsi_dbg(ERR_ZONE,
+ "%s: Failed to write the packet\n", __func__);
+ common->common_ops->print(ERR_ZONE,
+ skb->data,
+ skb->len);
+ }
+ dev_kfree_skb(skb);
+ return status;
+ }
+
+ bss = &info->control.vif->bss_conf;
+ wh = (struct ieee80211_hdr *)&skb->data[0];
+
+ if (common->fsm_state != FSM_MAC_INIT_DONE)
+ goto err;
+
+ if (FRAME_DESC_SZ > skb_headroom(skb))
+ goto err;
+ else
+ skb_push(skb, FRAME_DESC_SZ);
+
+ memset(skb->data, 0, FRAME_DESC_SZ);
+ msg = (unsigned short *)skb->data;
+
+ if (skb->len > MAX_MGMT_PKT_SIZE) {
+ rsi_dbg(INFO_ZONE, "%s: Dropping mgmt pkt > 512\n", __func__);
+ goto err;
+ }
+
+ msg[0] = cpu_to_le16((skb->len - FRAME_DESC_SZ) |
+ (RSI_WIFI_MGMT_Q << 12));
+ msg[1] = cpu_to_le16(TX_DOT11_MGMT);
+ msg[2] = cpu_to_le16(MIN_802_11_HDR_LEN << 8);
+ msg[3] = cpu_to_le16(RATE_INFO_ENABLE);
+ msg[6] = cpu_to_le16(wh->seq_ctrl >> 4);
+
+ if (wh->addr1[0] & 0x1)
+ msg[3] |= cpu_to_le16(RSI_BROADCAST_PKT);
+
+ if (common->band == IEEE80211_BAND_2GHZ)
+ msg[4] = cpu_to_le16(RSI_11B_MODE);
+ else
+ msg[4] = cpu_to_le16(0xB | RSI_11G_MODE);
+
+ /* Indicate to firmware to give cfm */
+ if ((skb->data[16] == 0x40) && (!bss->assoc)) {
+ msg[1] |= cpu_to_le16(1 << 10);
+ msg[7] = cpu_to_le16(PROBEREQ_CONFIRM);
+ common->mgmt_q_block = true;
+ }
+
+ msg[7] |= cpu_to_le16(vap_id << 8);
+
+ common->common_ops->print(MGMT_TX_ZONE,
+ (unsigned char *)msg,
+ skb->len);
+
+ status = common->common_ops->host_intf_write_pkt(common->priv,
+ (unsigned char *)msg,
+ skb->len);
+ if (status) {
+ rsi_dbg(ERR_ZONE, "%s: Failed to write the packet\n",
+ __func__);
+ common->common_ops->print(ERR_ZONE,
+ (unsigned char *)msg,
+ skb->len);
+ }
+
+err:
+ rsi_indicate_tx_status(common->priv, skb, status);
+ return status;
+}
+EXPORT_SYMBOL(rsi_send_mgmt_pkt);