]>
Commit | Line | Data |
---|---|---|
00b3ed16 GKH |
1 | /* src/p80211/p80211knetdev.c |
2 | * | |
3 | * Linux Kernel net device interface | |
4 | * | |
5 | * Copyright (C) 1999 AbsoluteValue Systems, Inc. All Rights Reserved. | |
6 | * -------------------------------------------------------------------- | |
7 | * | |
8 | * linux-wlan | |
9 | * | |
10 | * The contents of this file are subject to the Mozilla Public | |
11 | * License Version 1.1 (the "License"); you may not use this file | |
12 | * except in compliance with the License. You may obtain a copy of | |
13 | * the License at http://www.mozilla.org/MPL/ | |
14 | * | |
15 | * Software distributed under the License is distributed on an "AS | |
16 | * IS" basis, WITHOUT WARRANTY OF ANY KIND, either express or | |
17 | * implied. See the License for the specific language governing | |
18 | * rights and limitations under the License. | |
19 | * | |
20 | * Alternatively, the contents of this file may be used under the | |
21 | * terms of the GNU Public License version 2 (the "GPL"), in which | |
22 | * case the provisions of the GPL are applicable instead of the | |
23 | * above. If you wish to allow the use of your version of this file | |
24 | * only under the terms of the GPL and not to allow others to use | |
25 | * your version of this file under the MPL, indicate your decision | |
26 | * by deleting the provisions above and replace them with the notice | |
27 | * and other provisions required by the GPL. If you do not delete | |
28 | * the provisions above, a recipient may use your version of this | |
29 | * file under either the MPL or the GPL. | |
30 | * | |
31 | * -------------------------------------------------------------------- | |
32 | * | |
33 | * Inquiries regarding the linux-wlan Open Source project can be | |
34 | * made directly to: | |
35 | * | |
36 | * AbsoluteValue Systems Inc. | |
37 | * info@linux-wlan.com | |
38 | * http://www.linux-wlan.com | |
39 | * | |
40 | * -------------------------------------------------------------------- | |
41 | * | |
42 | * Portions of the development of this software were funded by | |
43 | * Intersil Corporation as part of PRISM(R) chipset product development. | |
44 | * | |
45 | * -------------------------------------------------------------------- | |
46 | * | |
47 | * The functions required for a Linux network device are defined here. | |
48 | * | |
49 | * -------------------------------------------------------------------- | |
50 | */ | |
51 | ||
00b3ed16 GKH |
52 | #include <linux/module.h> |
53 | #include <linux/kernel.h> | |
54 | #include <linux/sched.h> | |
55 | #include <linux/types.h> | |
56 | #include <linux/skbuff.h> | |
57 | #include <linux/slab.h> | |
58 | #include <linux/proc_fs.h> | |
59 | #include <linux/interrupt.h> | |
60 | #include <linux/netdevice.h> | |
61 | #include <linux/kmod.h> | |
62 | #include <linux/if_arp.h> | |
63 | #include <linux/wireless.h> | |
64 | #include <linux/sockios.h> | |
65 | #include <linux/etherdevice.h> | |
28b17a4b | 66 | #include <linux/if_ether.h> |
ae26230b | 67 | #include <linux/byteorder/generic.h> |
b4b3f0da MM |
68 | #include <linux/bitops.h> |
69 | #include <linux/uaccess.h> | |
00b3ed16 GKH |
70 | #include <asm/byteorder.h> |
71 | ||
72 | #ifdef SIOCETHTOOL | |
73 | #include <linux/ethtool.h> | |
74 | #endif | |
75 | ||
00b3ed16 | 76 | #include <net/iw_handler.h> |
00b3ed16 | 77 | #include <net/net_namespace.h> |
cb3126e6 | 78 | #include <net/cfg80211.h> |
00b3ed16 | 79 | |
00b3ed16 GKH |
80 | #include "p80211types.h" |
81 | #include "p80211hdr.h" | |
82 | #include "p80211conv.h" | |
83 | #include "p80211mgmt.h" | |
84 | #include "p80211msg.h" | |
85 | #include "p80211netdev.h" | |
86 | #include "p80211ioctl.h" | |
87 | #include "p80211req.h" | |
88 | #include "p80211metastruct.h" | |
89 | #include "p80211metadef.h" | |
90 | ||
cb3126e6 KR |
91 | #include "cfg80211.c" |
92 | ||
00b3ed16 GKH |
93 | /* Support functions */ |
94 | static void p80211netdev_rx_bh(unsigned long arg); | |
95 | ||
96 | /* netdevice method functions */ | |
297f06ce MT |
97 | static int p80211knetdev_init(netdevice_t *netdev); |
98 | static struct net_device_stats *p80211knetdev_get_stats(netdevice_t *netdev); | |
99 | static int p80211knetdev_open(netdevice_t *netdev); | |
100 | static int p80211knetdev_stop(netdevice_t *netdev); | |
b4b3f0da | 101 | static int p80211knetdev_hard_start_xmit(struct sk_buff *skb, |
297f06ce MT |
102 | netdevice_t *netdev); |
103 | static void p80211knetdev_set_multicast_list(netdevice_t *dev); | |
104 | static int p80211knetdev_do_ioctl(netdevice_t *dev, struct ifreq *ifr, | |
b4b3f0da | 105 | int cmd); |
297f06ce MT |
106 | static int p80211knetdev_set_mac_address(netdevice_t *dev, void *addr); |
107 | static void p80211knetdev_tx_timeout(netdevice_t *netdev); | |
108 | static int p80211_rx_typedrop(wlandevice_t *wlandev, u16 fc); | |
00b3ed16 | 109 | |
e02c69b8 SP |
110 | int wlan_watchdog = 5000; |
111 | module_param(wlan_watchdog, int, 0644); | |
112 | MODULE_PARM_DESC(wlan_watchdog, "transmit timeout in milliseconds"); | |
00b3ed16 | 113 | |
e02c69b8 SP |
114 | int wlan_wext_write = 1; |
115 | module_param(wlan_wext_write, int, 0644); | |
116 | MODULE_PARM_DESC(wlan_wext_write, "enable write wireless extensions"); | |
00b3ed16 | 117 | |
00b3ed16 GKH |
118 | /*---------------------------------------------------------------- |
119 | * p80211knetdev_init | |
120 | * | |
121 | * Init method for a Linux netdevice. Called in response to | |
122 | * register_netdev. | |
123 | * | |
124 | * Arguments: | |
125 | * none | |
126 | * | |
127 | * Returns: | |
128 | * nothing | |
129 | ----------------------------------------------------------------*/ | |
297f06ce | 130 | static int p80211knetdev_init(netdevice_t *netdev) |
00b3ed16 | 131 | { |
00b3ed16 GKH |
132 | /* Called in response to register_netdev */ |
133 | /* This is usually the probe function, but the probe has */ | |
134 | /* already been done by the MSD and the create_kdev */ | |
135 | /* function. All we do here is return success */ | |
00b3ed16 GKH |
136 | return 0; |
137 | } | |
138 | ||
00b3ed16 GKH |
139 | /*---------------------------------------------------------------- |
140 | * p80211knetdev_get_stats | |
141 | * | |
142 | * Statistics retrieval for linux netdevices. Here we're reporting | |
143 | * the Linux i/f level statistics. Hence, for the primary numbers, | |
144 | * we don't want to report the numbers from the MIB. Eventually, | |
145 | * it might be useful to collect some of the error counters though. | |
146 | * | |
147 | * Arguments: | |
148 | * netdev Linux netdevice | |
149 | * | |
150 | * Returns: | |
151 | * the address of the statistics structure | |
152 | ----------------------------------------------------------------*/ | |
75f49e07 | 153 | static struct net_device_stats *p80211knetdev_get_stats(netdevice_t * netdev) |
00b3ed16 | 154 | { |
b4b3f0da | 155 | wlandevice_t *wlandev = netdev->ml_priv; |
00b3ed16 GKH |
156 | |
157 | /* TODO: review the MIB stats for items that correspond to | |
b4b3f0da | 158 | linux stats */ |
00b3ed16 | 159 | |
00b3ed16 GKH |
160 | return &(wlandev->linux_stats); |
161 | } | |
162 | ||
00b3ed16 GKH |
163 | /*---------------------------------------------------------------- |
164 | * p80211knetdev_open | |
165 | * | |
166 | * Linux netdevice open method. Following a successful call here, | |
167 | * the device is supposed to be ready for tx and rx. In our | |
168 | * situation that may not be entirely true due to the state of the | |
169 | * MAC below. | |
170 | * | |
171 | * Arguments: | |
172 | * netdev Linux network device structure | |
173 | * | |
174 | * Returns: | |
175 | * zero on success, non-zero otherwise | |
176 | ----------------------------------------------------------------*/ | |
297f06ce | 177 | static int p80211knetdev_open(netdevice_t *netdev) |
00b3ed16 | 178 | { |
b4b3f0da MM |
179 | int result = 0; /* success */ |
180 | wlandevice_t *wlandev = netdev->ml_priv; | |
00b3ed16 | 181 | |
00b3ed16 | 182 | /* Check to make sure the MSD is running */ |
b4b3f0da | 183 | if (wlandev->msdstate != WLAN_MSD_RUNNING) |
00b3ed16 | 184 | return -ENODEV; |
00b3ed16 GKH |
185 | |
186 | /* Tell the MSD to open */ | |
b4b3f0da | 187 | if (wlandev->open != NULL) { |
00b3ed16 | 188 | result = wlandev->open(wlandev); |
b4b3f0da | 189 | if (result == 0) { |
cbec30c4 | 190 | netif_start_queue(wlandev->netdev); |
00b3ed16 GKH |
191 | wlandev->state = WLAN_DEVICE_OPEN; |
192 | } | |
193 | } else { | |
194 | result = -EAGAIN; | |
195 | } | |
196 | ||
00b3ed16 GKH |
197 | return result; |
198 | } | |
199 | ||
00b3ed16 GKH |
200 | /*---------------------------------------------------------------- |
201 | * p80211knetdev_stop | |
202 | * | |
203 | * Linux netdevice stop (close) method. Following this call, | |
204 | * no frames should go up or down through this interface. | |
205 | * | |
206 | * Arguments: | |
207 | * netdev Linux network device structure | |
208 | * | |
209 | * Returns: | |
210 | * zero on success, non-zero otherwise | |
211 | ----------------------------------------------------------------*/ | |
297f06ce | 212 | static int p80211knetdev_stop(netdevice_t *netdev) |
00b3ed16 | 213 | { |
b4b3f0da MM |
214 | int result = 0; |
215 | wlandevice_t *wlandev = netdev->ml_priv; | |
00b3ed16 | 216 | |
b4b3f0da | 217 | if (wlandev->close != NULL) |
00b3ed16 | 218 | result = wlandev->close(wlandev); |
00b3ed16 | 219 | |
cbec30c4 | 220 | netif_stop_queue(wlandev->netdev); |
00b3ed16 GKH |
221 | wlandev->state = WLAN_DEVICE_CLOSED; |
222 | ||
00b3ed16 GKH |
223 | return result; |
224 | } | |
225 | ||
226 | /*---------------------------------------------------------------- | |
227 | * p80211netdev_rx | |
228 | * | |
229 | * Frame receive function called by the mac specific driver. | |
230 | * | |
231 | * Arguments: | |
232 | * wlandev WLAN network device structure | |
233 | * skb skbuff containing a full 802.11 frame. | |
234 | * Returns: | |
235 | * nothing | |
236 | * Side effects: | |
237 | * | |
238 | ----------------------------------------------------------------*/ | |
297f06ce | 239 | void p80211netdev_rx(wlandevice_t *wlandev, struct sk_buff *skb) |
00b3ed16 | 240 | { |
00b3ed16 GKH |
241 | /* Enqueue for post-irq processing */ |
242 | skb_queue_tail(&wlandev->nsd_rxq, skb); | |
243 | ||
244 | tasklet_schedule(&wlandev->rx_bh); | |
245 | ||
00b3ed16 GKH |
246 | return; |
247 | } | |
248 | ||
249 | /*---------------------------------------------------------------- | |
250 | * p80211netdev_rx_bh | |
251 | * | |
252 | * Deferred processing of all received frames. | |
253 | * | |
254 | * Arguments: | |
255 | * wlandev WLAN network device structure | |
256 | * skb skbuff containing a full 802.11 frame. | |
257 | * Returns: | |
258 | * nothing | |
259 | * Side effects: | |
260 | * | |
261 | ----------------------------------------------------------------*/ | |
262 | static void p80211netdev_rx_bh(unsigned long arg) | |
263 | { | |
264 | wlandevice_t *wlandev = (wlandevice_t *) arg; | |
265 | struct sk_buff *skb = NULL; | |
b4b3f0da | 266 | netdevice_t *dev = wlandev->netdev; |
00b3ed16 | 267 | p80211_hdr_a3_t *hdr; |
aaad4303 | 268 | u16 fc; |
00b3ed16 | 269 | |
00b3ed16 | 270 | /* Let's empty our our queue */ |
b4b3f0da | 271 | while ((skb = skb_dequeue(&wlandev->nsd_rxq))) { |
00b3ed16 GKH |
272 | if (wlandev->state == WLAN_DEVICE_OPEN) { |
273 | ||
274 | if (dev->type != ARPHRD_ETHER) { | |
275 | /* RAW frame; we shouldn't convert it */ | |
b4b3f0da | 276 | /* XXX Append the Prism Header here instead. */ |
00b3ed16 GKH |
277 | |
278 | /* set up various data fields */ | |
279 | skb->dev = dev; | |
280 | skb_reset_mac_header(skb); | |
281 | skb->ip_summed = CHECKSUM_NONE; | |
282 | skb->pkt_type = PACKET_OTHERHOST; | |
283 | skb->protocol = htons(ETH_P_80211_RAW); | |
284 | dev->last_rx = jiffies; | |
285 | ||
286 | wlandev->linux_stats.rx_packets++; | |
287 | wlandev->linux_stats.rx_bytes += skb->len; | |
288 | netif_rx_ni(skb); | |
289 | continue; | |
290 | } else { | |
b4b3f0da | 291 | hdr = (p80211_hdr_a3_t *) skb->data; |
ae26230b | 292 | fc = le16_to_cpu(hdr->fc); |
00b3ed16 GKH |
293 | if (p80211_rx_typedrop(wlandev, fc)) { |
294 | dev_kfree_skb(skb); | |
295 | continue; | |
296 | } | |
297 | ||
298 | /* perform mcast filtering */ | |
299 | if (wlandev->netdev->flags & IFF_ALLMULTI) { | |
300 | /* allow my local address through */ | |
b4b3f0da MM |
301 | if (memcmp |
302 | (hdr->a1, wlandev->netdev->dev_addr, | |
303 | ETH_ALEN) != 0) { | |
00b3ed16 GKH |
304 | /* but reject anything else that isn't multicast */ |
305 | if (!(hdr->a1[0] & 0x01)) { | |
306 | dev_kfree_skb(skb); | |
307 | continue; | |
308 | } | |
309 | } | |
310 | } | |
311 | ||
b4b3f0da MM |
312 | if (skb_p80211_to_ether |
313 | (wlandev, wlandev->ethconv, skb) == 0) { | |
00b3ed16 GKH |
314 | skb->dev->last_rx = jiffies; |
315 | wlandev->linux_stats.rx_packets++; | |
b4b3f0da MM |
316 | wlandev->linux_stats.rx_bytes += |
317 | skb->len; | |
00b3ed16 GKH |
318 | netif_rx_ni(skb); |
319 | continue; | |
320 | } | |
b4b3f0da | 321 | pr_debug("p80211_to_ether failed.\n"); |
00b3ed16 GKH |
322 | } |
323 | } | |
324 | dev_kfree_skb(skb); | |
325 | } | |
00b3ed16 GKH |
326 | } |
327 | ||
00b3ed16 GKH |
328 | /*---------------------------------------------------------------- |
329 | * p80211knetdev_hard_start_xmit | |
330 | * | |
331 | * Linux netdevice method for transmitting a frame. | |
332 | * | |
333 | * Arguments: | |
334 | * skb Linux sk_buff containing the frame. | |
335 | * netdev Linux netdevice. | |
336 | * | |
337 | * Side effects: | |
338 | * If the lower layers report that buffers are full. netdev->tbusy | |
339 | * will be set to prevent higher layers from sending more traffic. | |
340 | * | |
341 | * Note: If this function returns non-zero, higher layers retain | |
342 | * ownership of the skb. | |
343 | * | |
344 | * Returns: | |
345 | * zero on success, non-zero on failure. | |
346 | ----------------------------------------------------------------*/ | |
b4b3f0da | 347 | static int p80211knetdev_hard_start_xmit(struct sk_buff *skb, |
297f06ce | 348 | netdevice_t *netdev) |
00b3ed16 | 349 | { |
b4b3f0da MM |
350 | int result = 0; |
351 | int txresult = -1; | |
352 | wlandevice_t *wlandev = netdev->ml_priv; | |
353 | p80211_hdr_t p80211_hdr; | |
00b3ed16 GKH |
354 | p80211_metawep_t p80211_wep; |
355 | ||
b4b3f0da | 356 | if (skb == NULL) |
ec634fe3 | 357 | return NETDEV_TX_OK; |
00b3ed16 | 358 | |
b4b3f0da | 359 | if (wlandev->state != WLAN_DEVICE_OPEN) { |
00b3ed16 GKH |
360 | result = 1; |
361 | goto failed; | |
362 | } | |
363 | ||
364 | memset(&p80211_hdr, 0, sizeof(p80211_hdr_t)); | |
365 | memset(&p80211_wep, 0, sizeof(p80211_metawep_t)); | |
366 | ||
b4b3f0da | 367 | if (netif_queue_stopped(netdev)) { |
a7cf7bae | 368 | pr_debug("called when queue stopped.\n"); |
00b3ed16 GKH |
369 | result = 1; |
370 | goto failed; | |
371 | } | |
372 | ||
373 | netif_stop_queue(netdev); | |
374 | ||
00b3ed16 | 375 | /* Check to see that a valid mode is set */ |
b4b3f0da | 376 | switch (wlandev->macmode) { |
00b3ed16 GKH |
377 | case WLAN_MACMODE_IBSS_STA: |
378 | case WLAN_MACMODE_ESS_STA: | |
379 | case WLAN_MACMODE_ESS_AP: | |
380 | break; | |
381 | default: | |
382 | /* Mode isn't set yet, just drop the frame | |
383 | * and return success . | |
384 | * TODO: we need a saner way to handle this | |
385 | */ | |
b4b3f0da | 386 | if (skb->protocol != ETH_P_80211_RAW) { |
cbec30c4 | 387 | netif_start_queue(wlandev->netdev); |
2acbf9de | 388 | printk(KERN_NOTICE |
b4b3f0da | 389 | "Tx attempt prior to association, frame dropped.\n"); |
00b3ed16 GKH |
390 | wlandev->linux_stats.tx_dropped++; |
391 | result = 0; | |
392 | goto failed; | |
393 | } | |
394 | break; | |
395 | } | |
396 | ||
397 | /* Check for raw transmits */ | |
b4b3f0da | 398 | if (skb->protocol == ETH_P_80211_RAW) { |
00b3ed16 GKH |
399 | if (!capable(CAP_NET_ADMIN)) { |
400 | result = 1; | |
401 | goto failed; | |
402 | } | |
403 | /* move the header over */ | |
404 | memcpy(&p80211_hdr, skb->data, sizeof(p80211_hdr_t)); | |
405 | skb_pull(skb, sizeof(p80211_hdr_t)); | |
406 | } else { | |
b4b3f0da MM |
407 | if (skb_ether_to_p80211 |
408 | (wlandev, wlandev->ethconv, skb, &p80211_hdr, | |
409 | &p80211_wep) != 0) { | |
00b3ed16 | 410 | /* convert failed */ |
a7cf7bae | 411 | pr_debug("ether_to_80211(%d) failed.\n", |
75f49e07 | 412 | wlandev->ethconv); |
00b3ed16 GKH |
413 | result = 1; |
414 | goto failed; | |
415 | } | |
416 | } | |
b4b3f0da | 417 | if (wlandev->txframe == NULL) { |
00b3ed16 GKH |
418 | result = 1; |
419 | goto failed; | |
420 | } | |
421 | ||
422 | netdev->trans_start = jiffies; | |
423 | ||
424 | wlandev->linux_stats.tx_packets++; | |
425 | /* count only the packet payload */ | |
426 | wlandev->linux_stats.tx_bytes += skb->len; | |
427 | ||
428 | txresult = wlandev->txframe(wlandev, skb, &p80211_hdr, &p80211_wep); | |
429 | ||
b4b3f0da | 430 | if (txresult == 0) { |
00b3ed16 GKH |
431 | /* success and more buf */ |
432 | /* avail, re: hw_txdata */ | |
cbec30c4 | 433 | netif_wake_queue(wlandev->netdev); |
5b548140 | 434 | result = NETDEV_TX_OK; |
b4b3f0da | 435 | } else if (txresult == 1) { |
00b3ed16 | 436 | /* success, no more avail */ |
a7cf7bae | 437 | pr_debug("txframe success, no more bufs\n"); |
00b3ed16 GKH |
438 | /* netdev->tbusy = 1; don't set here, irqhdlr */ |
439 | /* may have already cleared it */ | |
5b548140 | 440 | result = NETDEV_TX_OK; |
b4b3f0da | 441 | } else if (txresult == 2) { |
00b3ed16 | 442 | /* alloc failure, drop frame */ |
a7cf7bae | 443 | pr_debug("txframe returned alloc_fail\n"); |
5b548140 | 444 | result = NETDEV_TX_BUSY; |
00b3ed16 GKH |
445 | } else { |
446 | /* buffer full or queue busy, drop frame. */ | |
a7cf7bae | 447 | pr_debug("txframe returned full or busy\n"); |
5b548140 | 448 | result = NETDEV_TX_BUSY; |
00b3ed16 GKH |
449 | } |
450 | ||
b4b3f0da | 451 | failed: |
00b3ed16 GKH |
452 | /* Free up the WEP buffer if it's not the same as the skb */ |
453 | if ((p80211_wep.data) && (p80211_wep.data != skb->data)) | |
2f585191 | 454 | kzfree(p80211_wep.data); |
00b3ed16 GKH |
455 | |
456 | /* we always free the skb here, never in a lower level. */ | |
457 | if (!result) | |
458 | dev_kfree_skb(skb); | |
459 | ||
00b3ed16 GKH |
460 | return result; |
461 | } | |
462 | ||
00b3ed16 GKH |
463 | /*---------------------------------------------------------------- |
464 | * p80211knetdev_set_multicast_list | |
465 | * | |
466 | * Called from higher lavers whenever there's a need to set/clear | |
467 | * promiscuous mode or rewrite the multicast list. | |
468 | * | |
469 | * Arguments: | |
470 | * none | |
471 | * | |
472 | * Returns: | |
473 | * nothing | |
474 | ----------------------------------------------------------------*/ | |
297f06ce | 475 | static void p80211knetdev_set_multicast_list(netdevice_t *dev) |
00b3ed16 | 476 | { |
b4b3f0da | 477 | wlandevice_t *wlandev = dev->ml_priv; |
00b3ed16 | 478 | |
00b3ed16 GKH |
479 | /* TODO: real multicast support as well */ |
480 | ||
481 | if (wlandev->set_multicast_list) | |
482 | wlandev->set_multicast_list(wlandev, dev); | |
483 | ||
00b3ed16 GKH |
484 | } |
485 | ||
486 | #ifdef SIOCETHTOOL | |
487 | ||
297f06ce | 488 | static int p80211netdev_ethtool(wlandevice_t *wlandev, void __user *useraddr) |
00b3ed16 | 489 | { |
aaad4303 | 490 | u32 ethcmd; |
00b3ed16 GKH |
491 | struct ethtool_drvinfo info; |
492 | struct ethtool_value edata; | |
493 | ||
494 | memset(&info, 0, sizeof(info)); | |
495 | memset(&edata, 0, sizeof(edata)); | |
496 | ||
497 | if (copy_from_user(ðcmd, useraddr, sizeof(ethcmd))) | |
498 | return -EFAULT; | |
499 | ||
500 | switch (ethcmd) { | |
501 | case ETHTOOL_GDRVINFO: | |
502 | info.cmd = ethcmd; | |
503 | snprintf(info.driver, sizeof(info.driver), "p80211_%s", | |
504 | wlandev->nsdname); | |
505 | snprintf(info.version, sizeof(info.version), "%s", | |
506 | WLAN_RELEASE); | |
507 | ||
00b3ed16 GKH |
508 | if (copy_to_user(useraddr, &info, sizeof(info))) |
509 | return -EFAULT; | |
510 | return 0; | |
511 | #ifdef ETHTOOL_GLINK | |
512 | case ETHTOOL_GLINK: | |
513 | edata.cmd = ethcmd; | |
514 | ||
515 | if (wlandev->linkstatus && | |
516 | (wlandev->macmode != WLAN_MACMODE_NONE)) { | |
517 | edata.data = 1; | |
518 | } else { | |
519 | edata.data = 0; | |
520 | } | |
521 | ||
522 | if (copy_to_user(useraddr, &edata, sizeof(edata))) | |
b4b3f0da | 523 | return -EFAULT; |
00b3ed16 GKH |
524 | return 0; |
525 | } | |
526 | #endif | |
527 | ||
528 | return -EOPNOTSUPP; | |
529 | } | |
530 | ||
531 | #endif | |
532 | ||
533 | /*---------------------------------------------------------------- | |
534 | * p80211knetdev_do_ioctl | |
535 | * | |
536 | * Handle an ioctl call on one of our devices. Everything Linux | |
537 | * ioctl specific is done here. Then we pass the contents of the | |
538 | * ifr->data to the request message handler. | |
539 | * | |
540 | * Arguments: | |
541 | * dev Linux kernel netdevice | |
542 | * ifr Our private ioctl request structure, typed for the | |
543 | * generic struct ifreq so we can use ptr to func | |
544 | * w/o cast. | |
545 | * | |
546 | * Returns: | |
547 | * zero on success, a negative errno on failure. Possible values: | |
548 | * -ENETDOWN Device isn't up. | |
549 | * -EBUSY cmd already in progress | |
550 | * -ETIME p80211 cmd timed out (MSD may have its own timers) | |
551 | * -EFAULT memory fault copying msg from user buffer | |
552 | * -ENOMEM unable to allocate kernel msg buffer | |
553 | * -ENOSYS bad magic, it the cmd really for us? | |
aaad4303 | 554 | * -EintR sleeping on cmd, awakened by signal, cmd cancelled. |
00b3ed16 GKH |
555 | * |
556 | * Call Context: | |
557 | * Process thread (ioctl caller). TODO: SMP support may require | |
558 | * locks. | |
559 | ----------------------------------------------------------------*/ | |
297f06ce | 560 | static int p80211knetdev_do_ioctl(netdevice_t *dev, struct ifreq *ifr, int cmd) |
00b3ed16 | 561 | { |
b4b3f0da MM |
562 | int result = 0; |
563 | p80211ioctl_req_t *req = (p80211ioctl_req_t *) ifr; | |
564 | wlandevice_t *wlandev = dev->ml_priv; | |
565 | u8 *msgbuf; | |
00b3ed16 | 566 | |
a7cf7bae | 567 | pr_debug("rx'd ioctl, cmd=%d, len=%d\n", cmd, req->len); |
00b3ed16 | 568 | |
00b3ed16 GKH |
569 | #ifdef SIOCETHTOOL |
570 | if (cmd == SIOCETHTOOL) { | |
b4b3f0da MM |
571 | result = |
572 | p80211netdev_ethtool(wlandev, (void __user *)ifr->ifr_data); | |
00b3ed16 GKH |
573 | goto bail; |
574 | } | |
575 | #endif | |
576 | ||
577 | /* Test the magic, assume ifr is good if it's there */ | |
b4b3f0da | 578 | if (req->magic != P80211_IOCTL_MAGIC) { |
00b3ed16 GKH |
579 | result = -ENOSYS; |
580 | goto bail; | |
581 | } | |
582 | ||
b4b3f0da | 583 | if (cmd == P80211_IFTEST) { |
00b3ed16 GKH |
584 | result = 0; |
585 | goto bail; | |
b4b3f0da | 586 | } else if (cmd != P80211_IFREQ) { |
00b3ed16 GKH |
587 | result = -ENOSYS; |
588 | goto bail; | |
589 | } | |
590 | ||
591 | /* Allocate a buf of size req->len */ | |
5dd8acc8 SK |
592 | msgbuf = kmalloc(req->len, GFP_KERNEL); |
593 | if (msgbuf) { | |
b4b3f0da | 594 | if (copy_from_user(msgbuf, (void __user *)req->data, req->len)) |
00b3ed16 | 595 | result = -EFAULT; |
b4b3f0da MM |
596 | else |
597 | result = p80211req_dorequest(wlandev, msgbuf); | |
00b3ed16 | 598 | |
b4b3f0da MM |
599 | if (result == 0) { |
600 | if (copy_to_user | |
601 | ((void __user *)req->data, msgbuf, req->len)) { | |
00b3ed16 GKH |
602 | result = -EFAULT; |
603 | } | |
604 | } | |
605 | kfree(msgbuf); | |
606 | } else { | |
607 | result = -ENOMEM; | |
608 | } | |
609 | bail: | |
b4b3f0da | 610 | return result; /* If allocate,copyfrom or copyto fails, return errno */ |
00b3ed16 GKH |
611 | } |
612 | ||
613 | /*---------------------------------------------------------------- | |
614 | * p80211knetdev_set_mac_address | |
615 | * | |
616 | * Handles the ioctl for changing the MACAddress of a netdevice | |
617 | * | |
618 | * references: linux/netdevice.h and drivers/net/net_init.c | |
619 | * | |
620 | * NOTE: [MSM] We only prevent address changes when the netdev is | |
621 | * up. We don't control anything based on dot11 state. If the | |
622 | * address is changed on a STA that's currently associated, you | |
623 | * will probably lose the ability to send and receive data frames. | |
624 | * Just be aware. Therefore, this should usually only be done | |
625 | * prior to scan/join/auth/assoc. | |
626 | * | |
627 | * Arguments: | |
628 | * dev netdevice struct | |
629 | * addr the new MACAddress (a struct) | |
630 | * | |
631 | * Returns: | |
632 | * zero on success, a negative errno on failure. Possible values: | |
633 | * -EBUSY device is bussy (cmd not possible) | |
634 | * -and errors returned by: p80211req_dorequest(..) | |
635 | * | |
636 | * by: Collin R. Mulliner <collin@mulliner.org> | |
637 | ----------------------------------------------------------------*/ | |
297f06ce | 638 | static int p80211knetdev_set_mac_address(netdevice_t *dev, void *addr) |
00b3ed16 | 639 | { |
b4b3f0da MM |
640 | struct sockaddr *new_addr = addr; |
641 | p80211msg_dot11req_mibset_t dot11req; | |
642 | p80211item_unk392_t *mibattr; | |
643 | p80211item_pstr6_t *macaddr; | |
644 | p80211item_uint32_t *resultcode; | |
00b3ed16 GKH |
645 | int result = 0; |
646 | ||
00b3ed16 | 647 | /* If we're running, we don't allow MAC address changes */ |
b4b3f0da | 648 | if (netif_running(dev)) |
00b3ed16 | 649 | return -EBUSY; |
00b3ed16 GKH |
650 | |
651 | /* Set up some convenience pointers. */ | |
652 | mibattr = &dot11req.mibattribute; | |
5dd8acc8 | 653 | macaddr = (p80211item_pstr6_t *) &mibattr->data; |
00b3ed16 GKH |
654 | resultcode = &dot11req.resultcode; |
655 | ||
656 | /* Set up a dot11req_mibset */ | |
657 | memset(&dot11req, 0, sizeof(p80211msg_dot11req_mibset_t)); | |
658 | dot11req.msgcode = DIDmsg_dot11req_mibset; | |
659 | dot11req.msglen = sizeof(p80211msg_dot11req_mibset_t); | |
660 | memcpy(dot11req.devname, | |
b4b3f0da | 661 | ((wlandevice_t *) dev->ml_priv)->name, WLAN_DEVNAMELEN_MAX - 1); |
00b3ed16 GKH |
662 | |
663 | /* Set up the mibattribute argument */ | |
664 | mibattr->did = DIDmsg_dot11req_mibset_mibattribute; | |
665 | mibattr->status = P80211ENUM_msgitem_status_data_ok; | |
666 | mibattr->len = sizeof(mibattr->data); | |
667 | ||
668 | macaddr->did = DIDmib_dot11mac_dot11OperationTable_dot11MACAddress; | |
669 | macaddr->status = P80211ENUM_msgitem_status_data_ok; | |
670 | macaddr->len = sizeof(macaddr->data); | |
28b17a4b MM |
671 | macaddr->data.len = ETH_ALEN; |
672 | memcpy(&macaddr->data.data, new_addr->sa_data, ETH_ALEN); | |
00b3ed16 GKH |
673 | |
674 | /* Set up the resultcode argument */ | |
675 | resultcode->did = DIDmsg_dot11req_mibset_resultcode; | |
676 | resultcode->status = P80211ENUM_msgitem_status_no_value; | |
677 | resultcode->len = sizeof(resultcode->data); | |
678 | resultcode->data = 0; | |
679 | ||
680 | /* now fire the request */ | |
5dd8acc8 | 681 | result = p80211req_dorequest(dev->ml_priv, (u8 *) &dot11req); |
00b3ed16 GKH |
682 | |
683 | /* If the request wasn't successful, report an error and don't | |
684 | * change the netdev address | |
685 | */ | |
b4b3f0da | 686 | if (result != 0 || resultcode->data != P80211ENUM_resultcode_success) { |
edbd606c | 687 | printk(KERN_ERR |
b4b3f0da | 688 | "Low-level driver failed dot11req_mibset(dot11MACAddress).\n"); |
00b3ed16 GKH |
689 | result = -EADDRNOTAVAIL; |
690 | } else { | |
691 | /* everything's ok, change the addr in netdev */ | |
692 | memcpy(dev->dev_addr, new_addr->sa_data, dev->addr_len); | |
693 | } | |
694 | ||
00b3ed16 GKH |
695 | return result; |
696 | } | |
697 | ||
297f06ce | 698 | static int wlan_change_mtu(netdevice_t *dev, int new_mtu) |
00b3ed16 | 699 | { |
b4b3f0da MM |
700 | /* 2312 is max 802.11 payload, 20 is overhead, (ether + llc +snap) |
701 | and another 8 for wep. */ | |
702 | if ((new_mtu < 68) || (new_mtu > (2312 - 20 - 8))) | |
703 | return -EINVAL; | |
00b3ed16 | 704 | |
b4b3f0da | 705 | dev->mtu = new_mtu; |
00b3ed16 | 706 | |
b4b3f0da | 707 | return 0; |
00b3ed16 GKH |
708 | } |
709 | ||
cea96778 | 710 | static const struct net_device_ops p80211_netdev_ops = { |
75f49e07 MT |
711 | .ndo_init = p80211knetdev_init, |
712 | .ndo_open = p80211knetdev_open, | |
713 | .ndo_stop = p80211knetdev_stop, | |
714 | .ndo_get_stats = p80211knetdev_get_stats, | |
715 | .ndo_start_xmit = p80211knetdev_hard_start_xmit, | |
716 | .ndo_set_multicast_list = p80211knetdev_set_multicast_list, | |
717 | .ndo_do_ioctl = p80211knetdev_do_ioctl, | |
718 | .ndo_set_mac_address = p80211knetdev_set_mac_address, | |
719 | .ndo_tx_timeout = p80211knetdev_tx_timeout, | |
720 | .ndo_change_mtu = wlan_change_mtu, | |
721 | .ndo_validate_addr = eth_validate_addr, | |
cea96778 AB |
722 | }; |
723 | ||
00b3ed16 GKH |
724 | /*---------------------------------------------------------------- |
725 | * wlan_setup | |
726 | * | |
727 | * Roughly matches the functionality of ether_setup. Here | |
728 | * we set up any members of the wlandevice structure that are common | |
729 | * to all devices. Additionally, we allocate a linux 'struct device' | |
730 | * and perform the same setup as ether_setup. | |
731 | * | |
732 | * Note: It's important that the caller have setup the wlandev->name | |
733 | * ptr prior to calling this function. | |
734 | * | |
735 | * Arguments: | |
736 | * wlandev ptr to the wlandev structure for the | |
737 | * interface. | |
cb3126e6 | 738 | * physdev ptr to usb device |
00b3ed16 GKH |
739 | * Returns: |
740 | * zero on success, non-zero otherwise. | |
741 | * Call Context: | |
742 | * Should be process thread. We'll assume it might be | |
743 | * interrupt though. When we add support for statically | |
744 | * compiled drivers, this function will be called in the | |
745 | * context of the kernel startup code. | |
746 | ----------------------------------------------------------------*/ | |
cb3126e6 | 747 | int wlan_setup(wlandevice_t *wlandev, struct device *physdev) |
00b3ed16 | 748 | { |
b4b3f0da | 749 | int result = 0; |
cb3126e6 KR |
750 | netdevice_t *netdev; |
751 | struct wiphy *wiphy; | |
752 | struct wireless_dev *wdev; | |
00b3ed16 | 753 | |
00b3ed16 GKH |
754 | /* Set up the wlandev */ |
755 | wlandev->state = WLAN_DEVICE_CLOSED; | |
756 | wlandev->ethconv = WLAN_ETHCONV_8021h; | |
757 | wlandev->macmode = WLAN_MACMODE_NONE; | |
758 | ||
759 | /* Set up the rx queue */ | |
760 | skb_queue_head_init(&wlandev->nsd_rxq); | |
761 | tasklet_init(&wlandev->rx_bh, | |
b4b3f0da | 762 | p80211netdev_rx_bh, (unsigned long)wlandev); |
00b3ed16 | 763 | |
cb3126e6 KR |
764 | /* Allocate and initialize the wiphy struct */ |
765 | wiphy = wlan_create_wiphy(physdev, wlandev); | |
766 | if (wiphy == NULL) { | |
767 | printk(KERN_ERR "Failed to alloc wiphy.\n"); | |
768 | return 1; | |
769 | } | |
770 | ||
00b3ed16 | 771 | /* Allocate and initialize the struct device */ |
cb3126e6 KR |
772 | netdev = alloc_netdev(sizeof(struct wireless_dev), "wlan%d", ether_setup); |
773 | if (netdev == NULL) { | |
edbd606c | 774 | printk(KERN_ERR "Failed to alloc netdev.\n"); |
cb3126e6 | 775 | wlan_free_wiphy(wiphy); |
00b3ed16 GKH |
776 | result = 1; |
777 | } else { | |
cb3126e6 KR |
778 | wlandev->netdev = netdev; |
779 | netdev->ml_priv = wlandev; | |
780 | netdev->netdev_ops = &p80211_netdev_ops; | |
781 | wdev = netdev_priv(netdev); | |
782 | wdev->wiphy = wiphy; | |
783 | wdev->iftype = NL80211_IFTYPE_STATION; | |
784 | netdev->ieee80211_ptr = wdev; | |
785 | ||
786 | netif_stop_queue(netdev); | |
787 | netif_carrier_off(netdev); | |
00b3ed16 GKH |
788 | } |
789 | ||
00b3ed16 GKH |
790 | return result; |
791 | } | |
792 | ||
793 | /*---------------------------------------------------------------- | |
794 | * wlan_unsetup | |
795 | * | |
796 | * This function is paired with the wlan_setup routine. It should | |
797 | * be called after unregister_wlandev. Basically, all it does is | |
798 | * free the 'struct device' that's associated with the wlandev. | |
799 | * We do it here because the 'struct device' isn't allocated | |
800 | * explicitly in the driver code, it's done in wlan_setup. To | |
801 | * do the free in the driver might seem like 'magic'. | |
802 | * | |
803 | * Arguments: | |
804 | * wlandev ptr to the wlandev structure for the | |
805 | * interface. | |
806 | * Returns: | |
807 | * zero on success, non-zero otherwise. | |
808 | * Call Context: | |
809 | * Should be process thread. We'll assume it might be | |
810 | * interrupt though. When we add support for statically | |
811 | * compiled drivers, this function will be called in the | |
812 | * context of the kernel startup code. | |
813 | ----------------------------------------------------------------*/ | |
297f06ce | 814 | int wlan_unsetup(wlandevice_t *wlandev) |
00b3ed16 | 815 | { |
cb3126e6 | 816 | struct wireless_dev *wdev; |
00b3ed16 | 817 | |
00b3ed16 GKH |
818 | tasklet_kill(&wlandev->rx_bh); |
819 | ||
cb3126e6 KR |
820 | if (wlandev->netdev) { |
821 | wdev = netdev_priv(wlandev->netdev); | |
822 | if(wdev->wiphy) wlan_free_wiphy(wdev->wiphy); | |
00b3ed16 GKH |
823 | free_netdev(wlandev->netdev); |
824 | wlandev->netdev = NULL; | |
825 | } | |
826 | ||
00b3ed16 GKH |
827 | return 0; |
828 | } | |
829 | ||
00b3ed16 GKH |
830 | /*---------------------------------------------------------------- |
831 | * register_wlandev | |
832 | * | |
833 | * Roughly matches the functionality of register_netdev. This function | |
834 | * is called after the driver has successfully probed and set up the | |
835 | * resources for the device. It's now ready to become a named device | |
836 | * in the Linux system. | |
837 | * | |
838 | * First we allocate a name for the device (if not already set), then | |
839 | * we call the Linux function register_netdevice. | |
840 | * | |
841 | * Arguments: | |
842 | * wlandev ptr to the wlandev structure for the | |
843 | * interface. | |
844 | * Returns: | |
845 | * zero on success, non-zero otherwise. | |
846 | * Call Context: | |
847 | * Can be either interrupt or not. | |
848 | ----------------------------------------------------------------*/ | |
297f06ce | 849 | int register_wlandev(wlandevice_t *wlandev) |
00b3ed16 | 850 | { |
b4b3f0da | 851 | int i = 0; |
00b3ed16 | 852 | |
ee313528 RK |
853 | i = register_netdev(wlandev->netdev); |
854 | if (i) | |
855 | return i; | |
00b3ed16 | 856 | |
00b3ed16 GKH |
857 | return 0; |
858 | } | |
859 | ||
00b3ed16 GKH |
860 | /*---------------------------------------------------------------- |
861 | * unregister_wlandev | |
862 | * | |
863 | * Roughly matches the functionality of unregister_netdev. This | |
864 | * function is called to remove a named device from the system. | |
865 | * | |
866 | * First we tell linux that the device should no longer exist. | |
867 | * Then we remove it from the list of known wlan devices. | |
868 | * | |
869 | * Arguments: | |
870 | * wlandev ptr to the wlandev structure for the | |
871 | * interface. | |
872 | * Returns: | |
873 | * zero on success, non-zero otherwise. | |
874 | * Call Context: | |
875 | * Can be either interrupt or not. | |
876 | ----------------------------------------------------------------*/ | |
297f06ce | 877 | int unregister_wlandev(wlandevice_t *wlandev) |
00b3ed16 GKH |
878 | { |
879 | struct sk_buff *skb; | |
880 | ||
00b3ed16 GKH |
881 | unregister_netdev(wlandev->netdev); |
882 | ||
883 | /* Now to clean out the rx queue */ | |
b4b3f0da | 884 | while ((skb = skb_dequeue(&wlandev->nsd_rxq))) |
00b3ed16 | 885 | dev_kfree_skb(skb); |
00b3ed16 | 886 | |
00b3ed16 GKH |
887 | return 0; |
888 | } | |
889 | ||
00b3ed16 GKH |
890 | /*---------------------------------------------------------------- |
891 | * p80211netdev_hwremoved | |
892 | * | |
893 | * Hardware removed notification. This function should be called | |
894 | * immediately after an MSD has detected that the underlying hardware | |
895 | * has been yanked out from under us. The primary things we need | |
896 | * to do are: | |
897 | * - Mark the wlandev | |
898 | * - Prevent any further traffic from the knetdev i/f | |
899 | * - Prevent any further requests from mgmt i/f | |
900 | * - If there are any waitq'd mgmt requests or mgmt-frame exchanges, | |
901 | * shut them down. | |
902 | * - Call the MSD hwremoved function. | |
903 | * | |
904 | * The remainder of the cleanup will be handled by unregister(). | |
905 | * Our primary goal here is to prevent as much tickling of the MSD | |
906 | * as possible since the MSD is already in a 'wounded' state. | |
907 | * | |
908 | * TODO: As new features are added, this function should be | |
909 | * updated. | |
910 | * | |
911 | * Arguments: | |
912 | * wlandev WLAN network device structure | |
913 | * Returns: | |
914 | * nothing | |
915 | * Side effects: | |
916 | * | |
917 | * Call context: | |
918 | * Usually interrupt. | |
919 | ----------------------------------------------------------------*/ | |
297f06ce | 920 | void p80211netdev_hwremoved(wlandevice_t *wlandev) |
00b3ed16 | 921 | { |
00b3ed16 | 922 | wlandev->hwremoved = 1; |
b4b3f0da | 923 | if (wlandev->state == WLAN_DEVICE_OPEN) |
cbec30c4 | 924 | netif_stop_queue(wlandev->netdev); |
00b3ed16 GKH |
925 | |
926 | netif_device_detach(wlandev->netdev); | |
00b3ed16 GKH |
927 | } |
928 | ||
00b3ed16 GKH |
929 | /*---------------------------------------------------------------- |
930 | * p80211_rx_typedrop | |
931 | * | |
932 | * Classifies the frame, increments the appropriate counter, and | |
933 | * returns 0|1|2 indicating whether the driver should handle, ignore, or | |
934 | * drop the frame | |
935 | * | |
936 | * Arguments: | |
937 | * wlandev wlan device structure | |
938 | * fc frame control field | |
939 | * | |
940 | * Returns: | |
941 | * zero if the frame should be handled by the driver, | |
942 | * one if the frame should be ignored | |
943 | * anything else means we drop it. | |
944 | * | |
945 | * Side effects: | |
946 | * | |
947 | * Call context: | |
948 | * interrupt | |
949 | ----------------------------------------------------------------*/ | |
297f06ce | 950 | static int p80211_rx_typedrop(wlandevice_t *wlandev, u16 fc) |
00b3ed16 | 951 | { |
b4b3f0da MM |
952 | u16 ftype; |
953 | u16 fstype; | |
954 | int drop = 0; | |
00b3ed16 GKH |
955 | /* Classify frame, increment counter */ |
956 | ftype = WLAN_GET_FC_FTYPE(fc); | |
957 | fstype = WLAN_GET_FC_FSTYPE(fc); | |
958 | #if 0 | |
b4b3f0da | 959 | pr_debug("rx_typedrop : ftype=%d fstype=%d.\n", ftype, fstype); |
00b3ed16 | 960 | #endif |
b4b3f0da | 961 | switch (ftype) { |
00b3ed16 GKH |
962 | case WLAN_FTYPE_MGMT: |
963 | if ((wlandev->netdev->flags & IFF_PROMISC) || | |
b4b3f0da | 964 | (wlandev->netdev->flags & IFF_ALLMULTI)) { |
00b3ed16 GKH |
965 | drop = 1; |
966 | break; | |
967 | } | |
a7cf7bae | 968 | pr_debug("rx'd mgmt:\n"); |
00b3ed16 | 969 | wlandev->rx.mgmt++; |
b4b3f0da | 970 | switch (fstype) { |
00b3ed16 GKH |
971 | case WLAN_FSTYPE_ASSOCREQ: |
972 | /* printk("assocreq"); */ | |
973 | wlandev->rx.assocreq++; | |
974 | break; | |
975 | case WLAN_FSTYPE_ASSOCRESP: | |
976 | /* printk("assocresp"); */ | |
977 | wlandev->rx.assocresp++; | |
978 | break; | |
979 | case WLAN_FSTYPE_REASSOCREQ: | |
980 | /* printk("reassocreq"); */ | |
981 | wlandev->rx.reassocreq++; | |
982 | break; | |
983 | case WLAN_FSTYPE_REASSOCRESP: | |
984 | /* printk("reassocresp"); */ | |
985 | wlandev->rx.reassocresp++; | |
986 | break; | |
987 | case WLAN_FSTYPE_PROBEREQ: | |
988 | /* printk("probereq"); */ | |
989 | wlandev->rx.probereq++; | |
990 | break; | |
991 | case WLAN_FSTYPE_PROBERESP: | |
992 | /* printk("proberesp"); */ | |
993 | wlandev->rx.proberesp++; | |
994 | break; | |
995 | case WLAN_FSTYPE_BEACON: | |
996 | /* printk("beacon"); */ | |
997 | wlandev->rx.beacon++; | |
998 | break; | |
999 | case WLAN_FSTYPE_ATIM: | |
1000 | /* printk("atim"); */ | |
1001 | wlandev->rx.atim++; | |
1002 | break; | |
1003 | case WLAN_FSTYPE_DISASSOC: | |
1004 | /* printk("disassoc"); */ | |
1005 | wlandev->rx.disassoc++; | |
1006 | break; | |
1007 | case WLAN_FSTYPE_AUTHEN: | |
1008 | /* printk("authen"); */ | |
1009 | wlandev->rx.authen++; | |
1010 | break; | |
1011 | case WLAN_FSTYPE_DEAUTHEN: | |
1012 | /* printk("deauthen"); */ | |
1013 | wlandev->rx.deauthen++; | |
1014 | break; | |
1015 | default: | |
1016 | /* printk("unknown"); */ | |
1017 | wlandev->rx.mgmt_unknown++; | |
1018 | break; | |
1019 | } | |
1020 | /* printk("\n"); */ | |
1021 | drop = 2; | |
1022 | break; | |
1023 | ||
1024 | case WLAN_FTYPE_CTL: | |
1025 | if ((wlandev->netdev->flags & IFF_PROMISC) || | |
b4b3f0da | 1026 | (wlandev->netdev->flags & IFF_ALLMULTI)) { |
00b3ed16 GKH |
1027 | drop = 1; |
1028 | break; | |
1029 | } | |
a7cf7bae | 1030 | pr_debug("rx'd ctl:\n"); |
00b3ed16 | 1031 | wlandev->rx.ctl++; |
b4b3f0da | 1032 | switch (fstype) { |
00b3ed16 GKH |
1033 | case WLAN_FSTYPE_PSPOLL: |
1034 | /* printk("pspoll"); */ | |
1035 | wlandev->rx.pspoll++; | |
1036 | break; | |
1037 | case WLAN_FSTYPE_RTS: | |
1038 | /* printk("rts"); */ | |
1039 | wlandev->rx.rts++; | |
1040 | break; | |
1041 | case WLAN_FSTYPE_CTS: | |
1042 | /* printk("cts"); */ | |
1043 | wlandev->rx.cts++; | |
1044 | break; | |
1045 | case WLAN_FSTYPE_ACK: | |
1046 | /* printk("ack"); */ | |
1047 | wlandev->rx.ack++; | |
1048 | break; | |
1049 | case WLAN_FSTYPE_CFEND: | |
1050 | /* printk("cfend"); */ | |
1051 | wlandev->rx.cfend++; | |
1052 | break; | |
1053 | case WLAN_FSTYPE_CFENDCFACK: | |
1054 | /* printk("cfendcfack"); */ | |
1055 | wlandev->rx.cfendcfack++; | |
1056 | break; | |
1057 | default: | |
1058 | /* printk("unknown"); */ | |
1059 | wlandev->rx.ctl_unknown++; | |
1060 | break; | |
1061 | } | |
1062 | /* printk("\n"); */ | |
1063 | drop = 2; | |
1064 | break; | |
1065 | ||
1066 | case WLAN_FTYPE_DATA: | |
1067 | wlandev->rx.data++; | |
b4b3f0da | 1068 | switch (fstype) { |
00b3ed16 GKH |
1069 | case WLAN_FSTYPE_DATAONLY: |
1070 | wlandev->rx.dataonly++; | |
1071 | break; | |
1072 | case WLAN_FSTYPE_DATA_CFACK: | |
1073 | wlandev->rx.data_cfack++; | |
1074 | break; | |
1075 | case WLAN_FSTYPE_DATA_CFPOLL: | |
1076 | wlandev->rx.data_cfpoll++; | |
1077 | break; | |
1078 | case WLAN_FSTYPE_DATA_CFACK_CFPOLL: | |
1079 | wlandev->rx.data__cfack_cfpoll++; | |
1080 | break; | |
1081 | case WLAN_FSTYPE_NULL: | |
a7cf7bae | 1082 | pr_debug("rx'd data:null\n"); |
00b3ed16 GKH |
1083 | wlandev->rx.null++; |
1084 | break; | |
1085 | case WLAN_FSTYPE_CFACK: | |
a7cf7bae | 1086 | pr_debug("rx'd data:cfack\n"); |
00b3ed16 GKH |
1087 | wlandev->rx.cfack++; |
1088 | break; | |
1089 | case WLAN_FSTYPE_CFPOLL: | |
a7cf7bae | 1090 | pr_debug("rx'd data:cfpoll\n"); |
00b3ed16 GKH |
1091 | wlandev->rx.cfpoll++; |
1092 | break; | |
1093 | case WLAN_FSTYPE_CFACK_CFPOLL: | |
a7cf7bae | 1094 | pr_debug("rx'd data:cfack_cfpoll\n"); |
00b3ed16 GKH |
1095 | wlandev->rx.cfack_cfpoll++; |
1096 | break; | |
1097 | default: | |
1098 | /* printk("unknown"); */ | |
1099 | wlandev->rx.data_unknown++; | |
1100 | break; | |
1101 | } | |
1102 | ||
1103 | break; | |
1104 | } | |
1105 | return drop; | |
1106 | } | |
1107 | ||
297f06ce | 1108 | static void p80211knetdev_tx_timeout(netdevice_t *netdev) |
00b3ed16 | 1109 | { |
b4b3f0da | 1110 | wlandevice_t *wlandev = netdev->ml_priv; |
00b3ed16 GKH |
1111 | |
1112 | if (wlandev->tx_timeout) { | |
1113 | wlandev->tx_timeout(wlandev); | |
1114 | } else { | |
9b9556ec | 1115 | printk(KERN_WARNING "Implement tx_timeout for %s\n", |
b4b3f0da | 1116 | wlandev->nsdname); |
cbec30c4 | 1117 | netif_wake_queue(wlandev->netdev); |
00b3ed16 | 1118 | } |
00b3ed16 | 1119 | } |