2 * This file contains the handling of TX in wlan driver.
4 #include <linux/netdevice.h>
5 #include <linux/etherdevice.h>
15 * @brief This function converts Tx/Rx rates from IEEE80211_RADIOTAP_RATE
16 * units (500 Kb/s) into Marvell WLAN format (see Table 8 in Section 3.2.1)
18 * @param rate Input rate
19 * @return Output Rate (0 if invalid)
21 static u32
convert_radiotap_rate_to_mv(u8 rate
)
28 case 11: /* 5.5 Mbps */
30 case 22: /* 11 Mbps */
36 case 24: /* 12 Mbps */
38 case 36: /* 18 Mbps */
40 case 48: /* 24 Mbps */
42 case 72: /* 36 Mbps */
44 case 96: /* 48 Mbps */
46 case 108: /* 54 Mbps */
53 * @brief This function checks the conditions and sends packet to IF
54 * layer if everything is ok.
56 * @param priv A pointer to struct lbs_private structure
57 * @param skb A pointer to skb which includes TX packet
60 netdev_tx_t
lbs_hard_start_xmit(struct sk_buff
*skb
, struct net_device
*dev
)
63 struct lbs_private
*priv
= dev
->ml_priv
;
67 netdev_tx_t ret
= NETDEV_TX_OK
;
69 lbs_deb_enter(LBS_DEB_TX
);
71 /* We need to protect against the queues being restarted before
72 we get round to stopping them */
73 spin_lock_irqsave(&priv
->driver_lock
, flags
);
75 if (priv
->surpriseremoved
)
78 if (!skb
->len
|| (skb
->len
> MRVDRV_ETH_TX_PACKET_BUFFER_SIZE
)) {
79 lbs_deb_tx("tx err: skb length %d 0 or > %zd\n",
80 skb
->len
, MRVDRV_ETH_TX_PACKET_BUFFER_SIZE
);
81 /* We'll never manage to send this one; drop it and return 'OK' */
83 dev
->stats
.tx_dropped
++;
84 dev
->stats
.tx_errors
++;
89 netif_stop_queue(priv
->dev
);
91 netif_stop_queue(priv
->mesh_dev
);
93 if (priv
->tx_pending_len
) {
94 /* This can happen if packets come in on the mesh and eth
95 device simultaneously -- there's no mutual exclusion on
96 hard_start_xmit() calls between devices. */
97 lbs_deb_tx("Packet on %s while busy\n", dev
->name
);
102 priv
->tx_pending_len
= -1;
103 spin_unlock_irqrestore(&priv
->driver_lock
, flags
);
105 lbs_deb_hex(LBS_DEB_TX
, "TX Data", skb
->data
, min_t(unsigned int, skb
->len
, 100));
107 txpd
= (void *)priv
->tx_pending_buf
;
108 memset(txpd
, 0, sizeof(struct txpd
));
110 p802x_hdr
= skb
->data
;
113 if (dev
== priv
->rtap_net_dev
) {
114 struct tx_radiotap_hdr
*rtap_hdr
= (void *)skb
->data
;
116 /* set txpd fields from the radiotap header */
117 txpd
->tx_control
= cpu_to_le32(convert_radiotap_rate_to_mv(rtap_hdr
->rate
));
119 /* skip the radiotap header */
120 p802x_hdr
+= sizeof(*rtap_hdr
);
121 pkt_len
-= sizeof(*rtap_hdr
);
123 /* copy destination address from 802.11 header */
124 memcpy(txpd
->tx_dest_addr_high
, p802x_hdr
+ 4, ETH_ALEN
);
126 /* copy destination address from 802.3 header */
127 memcpy(txpd
->tx_dest_addr_high
, p802x_hdr
, ETH_ALEN
);
130 txpd
->tx_packet_length
= cpu_to_le16(pkt_len
);
131 txpd
->tx_packet_location
= cpu_to_le32(sizeof(struct txpd
));
133 if (dev
== priv
->mesh_dev
) {
134 if (priv
->mesh_fw_ver
== MESH_FW_OLD
)
135 txpd
->tx_control
|= cpu_to_le32(TxPD_MESH_FRAME
);
136 else if (priv
->mesh_fw_ver
== MESH_FW_NEW
)
137 txpd
->u
.bss
.bss_num
= MESH_IFACE_ID
;
140 lbs_deb_hex(LBS_DEB_TX
, "txpd", (u8
*) &txpd
, sizeof(struct txpd
));
142 lbs_deb_hex(LBS_DEB_TX
, "Tx Data", (u8
*) p802x_hdr
, le16_to_cpu(txpd
->tx_packet_length
));
144 memcpy(&txpd
[1], p802x_hdr
, le16_to_cpu(txpd
->tx_packet_length
));
146 spin_lock_irqsave(&priv
->driver_lock
, flags
);
147 priv
->tx_pending_len
= pkt_len
+ sizeof(struct txpd
);
149 lbs_deb_tx("%s lined up packet\n", __func__
);
151 dev
->stats
.tx_packets
++;
152 dev
->stats
.tx_bytes
+= skb
->len
;
154 dev
->trans_start
= jiffies
;
156 if (priv
->monitormode
) {
157 /* Keep the skb to echo it back once Tx feedback is
161 /* Keep the skb around for when we get feedback */
162 priv
->currenttxskb
= skb
;
165 dev_kfree_skb_any(skb
);
168 spin_unlock_irqrestore(&priv
->driver_lock
, flags
);
169 wake_up(&priv
->waitq
);
171 lbs_deb_leave_args(LBS_DEB_TX
, "ret %d", ret
);
176 * @brief This function sends to the host the last transmitted packet,
177 * filling the radiotap headers with transmission information.
179 * @param priv A pointer to struct lbs_private structure
180 * @param status A 32 bit value containing transmission status.
184 void lbs_send_tx_feedback(struct lbs_private
*priv
, u32 try_count
)
186 struct tx_radiotap_hdr
*radiotap_hdr
;
188 if (!priv
->monitormode
|| priv
->currenttxskb
== NULL
)
191 radiotap_hdr
= (struct tx_radiotap_hdr
*)priv
->currenttxskb
->data
;
193 radiotap_hdr
->data_retries
= try_count
?
194 (1 + priv
->txretrycount
- try_count
) : 0;
196 priv
->currenttxskb
->protocol
= eth_type_trans(priv
->currenttxskb
,
198 netif_rx(priv
->currenttxskb
);
200 priv
->currenttxskb
= NULL
;
202 if (priv
->connect_status
== LBS_CONNECTED
)
203 netif_wake_queue(priv
->dev
);
205 if (priv
->mesh_dev
&& (priv
->mesh_connect_status
== LBS_CONNECTED
))
206 netif_wake_queue(priv
->mesh_dev
);
208 EXPORT_SYMBOL_GPL(lbs_send_tx_feedback
);