1
2
3
4#include <linux/netdevice.h>
5#include <linux/etherdevice.h>
6#include <linux/sched.h>
7
8#include "hostcmd.h"
9#include "radiotap.h"
10#include "decl.h"
11#include "defs.h"
12#include "dev.h"
13#include "wext.h"
14
15
16
17
18
19
20
21
22static u32 convert_radiotap_rate_to_mv(u8 rate)
23{
24 switch (rate) {
25 case 2:
26 return 0 | (1 << 4);
27 case 4:
28 return 1 | (1 << 4);
29 case 11:
30 return 2 | (1 << 4);
31 case 22:
32 return 3 | (1 << 4);
33 case 12:
34 return 4 | (1 << 4);
35 case 18:
36 return 5 | (1 << 4);
37 case 24:
38 return 6 | (1 << 4);
39 case 36:
40 return 7 | (1 << 4);
41 case 48:
42 return 8 | (1 << 4);
43 case 72:
44 return 9 | (1 << 4);
45 case 96:
46 return 10 | (1 << 4);
47 case 108:
48 return 11 | (1 << 4);
49 }
50 return 0;
51}
52
53
54
55
56
57
58
59
60
61netdev_tx_t lbs_hard_start_xmit(struct sk_buff *skb, struct net_device *dev)
62{
63 unsigned long flags;
64 struct lbs_private *priv = dev->ml_priv;
65 struct txpd *txpd;
66 char *p802x_hdr;
67 uint16_t pkt_len;
68 netdev_tx_t ret = NETDEV_TX_OK;
69
70 lbs_deb_enter(LBS_DEB_TX);
71
72
73
74 spin_lock_irqsave(&priv->driver_lock, flags);
75
76 if (priv->surpriseremoved)
77 goto free;
78
79 if (!skb->len || (skb->len > MRVDRV_ETH_TX_PACKET_BUFFER_SIZE)) {
80 lbs_deb_tx("tx err: skb length %d 0 or > %zd\n",
81 skb->len, MRVDRV_ETH_TX_PACKET_BUFFER_SIZE);
82
83
84 dev->stats.tx_dropped++;
85 dev->stats.tx_errors++;
86 goto free;
87 }
88
89
90 netif_stop_queue(priv->dev);
91 if (priv->mesh_dev)
92 netif_stop_queue(priv->mesh_dev);
93
94 if (priv->tx_pending_len) {
95
96
97
98 lbs_deb_tx("Packet on %s while busy\n", dev->name);
99 ret = NETDEV_TX_BUSY;
100 goto unlock;
101 }
102
103 priv->tx_pending_len = -1;
104 spin_unlock_irqrestore(&priv->driver_lock, flags);
105
106 lbs_deb_hex(LBS_DEB_TX, "TX Data", skb->data, min_t(unsigned int, skb->len, 100));
107
108 txpd = (void *)priv->tx_pending_buf;
109 memset(txpd, 0, sizeof(struct txpd));
110
111 p802x_hdr = skb->data;
112 pkt_len = skb->len;
113
114 if (dev == priv->rtap_net_dev) {
115 struct tx_radiotap_hdr *rtap_hdr = (void *)skb->data;
116
117
118 txpd->tx_control = cpu_to_le32(convert_radiotap_rate_to_mv(rtap_hdr->rate));
119
120
121 p802x_hdr += sizeof(*rtap_hdr);
122 pkt_len -= sizeof(*rtap_hdr);
123
124
125 memcpy(txpd->tx_dest_addr_high, p802x_hdr + 4, ETH_ALEN);
126 } else {
127
128 memcpy(txpd->tx_dest_addr_high, p802x_hdr, ETH_ALEN);
129 }
130
131 txpd->tx_packet_length = cpu_to_le16(pkt_len);
132 txpd->tx_packet_location = cpu_to_le32(sizeof(struct txpd));
133
134 if (dev == priv->mesh_dev) {
135 if (priv->mesh_fw_ver == MESH_FW_OLD)
136 txpd->tx_control |= cpu_to_le32(TxPD_MESH_FRAME);
137 else if (priv->mesh_fw_ver == MESH_FW_NEW)
138 txpd->u.bss.bss_num = MESH_IFACE_ID;
139 }
140
141 lbs_deb_hex(LBS_DEB_TX, "txpd", (u8 *) &txpd, sizeof(struct txpd));
142
143 lbs_deb_hex(LBS_DEB_TX, "Tx Data", (u8 *) p802x_hdr, le16_to_cpu(txpd->tx_packet_length));
144
145 memcpy(&txpd[1], p802x_hdr, le16_to_cpu(txpd->tx_packet_length));
146
147 spin_lock_irqsave(&priv->driver_lock, flags);
148 priv->tx_pending_len = pkt_len + sizeof(struct txpd);
149
150 lbs_deb_tx("%s lined up packet\n", __func__);
151
152 dev->stats.tx_packets++;
153 dev->stats.tx_bytes += skb->len;
154
155 dev->trans_start = jiffies;
156
157 if (priv->monitormode) {
158
159
160 skb_orphan(skb);
161
162
163 priv->currenttxskb = skb;
164 } else {
165 free:
166 dev_kfree_skb_any(skb);
167 }
168 unlock:
169 spin_unlock_irqrestore(&priv->driver_lock, flags);
170 wake_up(&priv->waitq);
171
172 lbs_deb_leave_args(LBS_DEB_TX, "ret %d", ret);
173 return ret;
174}
175
176
177
178
179
180
181
182
183
184
185void lbs_send_tx_feedback(struct lbs_private *priv, u32 try_count)
186{
187 struct tx_radiotap_hdr *radiotap_hdr;
188
189 if (!priv->monitormode || priv->currenttxskb == NULL)
190 return;
191
192 radiotap_hdr = (struct tx_radiotap_hdr *)priv->currenttxskb->data;
193
194 radiotap_hdr->data_retries = try_count ?
195 (1 + priv->txretrycount - try_count) : 0;
196
197 priv->currenttxskb->protocol = eth_type_trans(priv->currenttxskb,
198 priv->rtap_net_dev);
199 netif_rx(priv->currenttxskb);
200
201 priv->currenttxskb = NULL;
202
203 if (priv->connect_status == LBS_CONNECTED)
204 netif_wake_queue(priv->dev);
205
206 if (priv->mesh_dev && (priv->mesh_connect_status == LBS_CONNECTED))
207 netif_wake_queue(priv->mesh_dev);
208}
209EXPORT_SYMBOL_GPL(lbs_send_tx_feedback);
210