1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * Host AP (software wireless LAN access point) driver for
4 * Intersil Prism2/2.5/3 - hostap.o module, common routines
5 *
6 * Copyright (c) 2001-2002, SSH Communications Security Corp and Jouni Malinen
7 * <j@w1.fi>
8 * Copyright (c) 2002-2005, Jouni Malinen <j@w1.fi>
9 */
10
11 #include <linux/module.h>
12 #include <linux/init.h>
13 #include <linux/slab.h>
14 #include <linux/proc_fs.h>
15 #include <linux/if_arp.h>
16 #include <linux/delay.h>
17 #include <linux/random.h>
18 #include <linux/workqueue.h>
19 #include <linux/kmod.h>
20 #include <linux/rtnetlink.h>
21 #include <linux/wireless.h>
22 #include <linux/etherdevice.h>
23 #include <net/net_namespace.h>
24 #include <net/iw_handler.h>
25 #include <net/lib80211.h>
26 #include <linux/uaccess.h>
27
28 #include "hostap_wlan.h"
29 #include "hostap_80211.h"
30 #include "hostap_ap.h"
31 #include "hostap.h"
32
33 MODULE_AUTHOR("Jouni Malinen");
34 MODULE_DESCRIPTION("Host AP common routines");
35 MODULE_LICENSE("GPL");
36
37 #define TX_TIMEOUT (2 * HZ)
38
39 #define PRISM2_MAX_FRAME_SIZE 2304
40 #define PRISM2_MIN_MTU 256
41 /* FIX: */
42 #define PRISM2_MAX_MTU (PRISM2_MAX_FRAME_SIZE - (6 /* LLC */ + 8 /* WEP */))
43
44
hostap_add_interface(struct local_info * local,int type,int rtnl_locked,const char * prefix,const char * name)45 struct net_device * hostap_add_interface(struct local_info *local,
46 int type, int rtnl_locked,
47 const char *prefix,
48 const char *name)
49 {
50 struct net_device *dev, *mdev;
51 struct hostap_interface *iface;
52 int ret;
53
54 dev = alloc_etherdev(sizeof(struct hostap_interface));
55 if (dev == NULL)
56 return NULL;
57
58 iface = netdev_priv(dev);
59 iface->dev = dev;
60 iface->local = local;
61 iface->type = type;
62 list_add(&iface->list, &local->hostap_interfaces);
63
64 mdev = local->dev;
65 eth_hw_addr_inherit(dev, mdev);
66 dev->base_addr = mdev->base_addr;
67 dev->irq = mdev->irq;
68 dev->mem_start = mdev->mem_start;
69 dev->mem_end = mdev->mem_end;
70
71 hostap_setup_dev(dev, local, type);
72 dev->needs_free_netdev = true;
73
74 sprintf(dev->name, "%s%s", prefix, name);
75 if (!rtnl_locked)
76 rtnl_lock();
77
78 SET_NETDEV_DEV(dev, mdev->dev.parent);
79 ret = register_netdevice(dev);
80
81 if (!rtnl_locked)
82 rtnl_unlock();
83
84 if (ret < 0) {
85 printk(KERN_WARNING "%s: failed to add new netdevice!\n",
86 dev->name);
87 free_netdev(dev);
88 return NULL;
89 }
90
91 printk(KERN_DEBUG "%s: registered netdevice %s\n",
92 mdev->name, dev->name);
93
94 return dev;
95 }
96
97
hostap_remove_interface(struct net_device * dev,int rtnl_locked,int remove_from_list)98 void hostap_remove_interface(struct net_device *dev, int rtnl_locked,
99 int remove_from_list)
100 {
101 struct hostap_interface *iface;
102
103 if (!dev)
104 return;
105
106 iface = netdev_priv(dev);
107
108 if (remove_from_list) {
109 list_del(&iface->list);
110 }
111
112 if (dev == iface->local->ddev)
113 iface->local->ddev = NULL;
114 else if (dev == iface->local->apdev)
115 iface->local->apdev = NULL;
116 else if (dev == iface->local->stadev)
117 iface->local->stadev = NULL;
118
119 if (rtnl_locked)
120 unregister_netdevice(dev);
121 else
122 unregister_netdev(dev);
123
124 /* 'dev->needs_free_netdev = true' implies device data, including
125 * private data, will be freed when the device is removed */
126 }
127
128
prism2_wds_special_addr(u8 * addr)129 static inline int prism2_wds_special_addr(u8 *addr)
130 {
131 if (addr[0] || addr[1] || addr[2] || addr[3] || addr[4] || addr[5])
132 return 0;
133
134 return 1;
135 }
136
137
prism2_wds_add(local_info_t * local,u8 * remote_addr,int rtnl_locked)138 int prism2_wds_add(local_info_t *local, u8 *remote_addr,
139 int rtnl_locked)
140 {
141 struct net_device *dev;
142 struct list_head *ptr;
143 struct hostap_interface *iface, *empty, *match;
144
145 empty = match = NULL;
146 read_lock_bh(&local->iface_lock);
147 list_for_each(ptr, &local->hostap_interfaces) {
148 iface = list_entry(ptr, struct hostap_interface, list);
149 if (iface->type != HOSTAP_INTERFACE_WDS)
150 continue;
151
152 if (prism2_wds_special_addr(iface->u.wds.remote_addr))
153 empty = iface;
154 else if (ether_addr_equal(iface->u.wds.remote_addr, remote_addr)) {
155 match = iface;
156 break;
157 }
158 }
159 if (!match && empty && !prism2_wds_special_addr(remote_addr)) {
160 /* take pre-allocated entry into use */
161 memcpy(empty->u.wds.remote_addr, remote_addr, ETH_ALEN);
162 read_unlock_bh(&local->iface_lock);
163 printk(KERN_DEBUG "%s: using pre-allocated WDS netdevice %s\n",
164 local->dev->name, empty->dev->name);
165 return 0;
166 }
167 read_unlock_bh(&local->iface_lock);
168
169 if (!prism2_wds_special_addr(remote_addr)) {
170 if (match)
171 return -EEXIST;
172 hostap_add_sta(local->ap, remote_addr);
173 }
174
175 if (local->wds_connections >= local->wds_max_connections)
176 return -ENOBUFS;
177
178 /* verify that there is room for wds# postfix in the interface name */
179 if (strlen(local->dev->name) >= IFNAMSIZ - 5) {
180 printk(KERN_DEBUG "'%s' too long base device name\n",
181 local->dev->name);
182 return -EINVAL;
183 }
184
185 dev = hostap_add_interface(local, HOSTAP_INTERFACE_WDS, rtnl_locked,
186 local->ddev->name, "wds%d");
187 if (dev == NULL)
188 return -ENOMEM;
189
190 iface = netdev_priv(dev);
191 memcpy(iface->u.wds.remote_addr, remote_addr, ETH_ALEN);
192
193 local->wds_connections++;
194
195 return 0;
196 }
197
198
prism2_wds_del(local_info_t * local,u8 * remote_addr,int rtnl_locked,int do_not_remove)199 int prism2_wds_del(local_info_t *local, u8 *remote_addr,
200 int rtnl_locked, int do_not_remove)
201 {
202 unsigned long flags;
203 struct list_head *ptr;
204 struct hostap_interface *iface, *selected = NULL;
205
206 write_lock_irqsave(&local->iface_lock, flags);
207 list_for_each(ptr, &local->hostap_interfaces) {
208 iface = list_entry(ptr, struct hostap_interface, list);
209 if (iface->type != HOSTAP_INTERFACE_WDS)
210 continue;
211
212 if (ether_addr_equal(iface->u.wds.remote_addr, remote_addr)) {
213 selected = iface;
214 break;
215 }
216 }
217 if (selected && !do_not_remove)
218 list_del(&selected->list);
219 write_unlock_irqrestore(&local->iface_lock, flags);
220
221 if (selected) {
222 if (do_not_remove)
223 eth_zero_addr(selected->u.wds.remote_addr);
224 else {
225 hostap_remove_interface(selected->dev, rtnl_locked, 0);
226 local->wds_connections--;
227 }
228 }
229
230 return selected ? 0 : -ENODEV;
231 }
232
233
hostap_tx_callback_register(local_info_t * local,void (* func)(struct sk_buff *,int ok,void *),void * data)234 u16 hostap_tx_callback_register(local_info_t *local,
235 void (*func)(struct sk_buff *, int ok, void *),
236 void *data)
237 {
238 unsigned long flags;
239 struct hostap_tx_callback_info *entry;
240
241 entry = kmalloc(sizeof(*entry), GFP_KERNEL);
242 if (entry == NULL)
243 return 0;
244
245 entry->func = func;
246 entry->data = data;
247
248 spin_lock_irqsave(&local->lock, flags);
249 entry->idx = local->tx_callback ? local->tx_callback->idx + 1 : 1;
250 entry->next = local->tx_callback;
251 local->tx_callback = entry;
252 spin_unlock_irqrestore(&local->lock, flags);
253
254 return entry->idx;
255 }
256
257
hostap_tx_callback_unregister(local_info_t * local,u16 idx)258 int hostap_tx_callback_unregister(local_info_t *local, u16 idx)
259 {
260 unsigned long flags;
261 struct hostap_tx_callback_info *cb, *prev = NULL;
262
263 spin_lock_irqsave(&local->lock, flags);
264 cb = local->tx_callback;
265 while (cb != NULL && cb->idx != idx) {
266 prev = cb;
267 cb = cb->next;
268 }
269 if (cb) {
270 if (prev == NULL)
271 local->tx_callback = cb->next;
272 else
273 prev->next = cb->next;
274 kfree(cb);
275 }
276 spin_unlock_irqrestore(&local->lock, flags);
277
278 return cb ? 0 : -1;
279 }
280
281
282 /* val is in host byte order */
hostap_set_word(struct net_device * dev,int rid,u16 val)283 int hostap_set_word(struct net_device *dev, int rid, u16 val)
284 {
285 struct hostap_interface *iface;
286 __le16 tmp = cpu_to_le16(val);
287 iface = netdev_priv(dev);
288 return iface->local->func->set_rid(dev, rid, &tmp, 2);
289 }
290
291
hostap_set_string(struct net_device * dev,int rid,const char * val)292 int hostap_set_string(struct net_device *dev, int rid, const char *val)
293 {
294 struct hostap_interface *iface;
295 char buf[MAX_SSID_LEN + 2];
296 int len;
297
298 iface = netdev_priv(dev);
299 len = strlen(val);
300 if (len > MAX_SSID_LEN)
301 return -1;
302 memset(buf, 0, sizeof(buf));
303 buf[0] = len; /* little endian 16 bit word */
304 memcpy(buf + 2, val, len);
305
306 return iface->local->func->set_rid(dev, rid, &buf, MAX_SSID_LEN + 2);
307 }
308
309
hostap_get_porttype(local_info_t * local)310 u16 hostap_get_porttype(local_info_t *local)
311 {
312 if (local->iw_mode == IW_MODE_ADHOC && local->pseudo_adhoc)
313 return HFA384X_PORTTYPE_PSEUDO_IBSS;
314 if (local->iw_mode == IW_MODE_ADHOC)
315 return HFA384X_PORTTYPE_IBSS;
316 if (local->iw_mode == IW_MODE_INFRA)
317 return HFA384X_PORTTYPE_BSS;
318 if (local->iw_mode == IW_MODE_REPEAT)
319 return HFA384X_PORTTYPE_WDS;
320 if (local->iw_mode == IW_MODE_MONITOR)
321 return HFA384X_PORTTYPE_PSEUDO_IBSS;
322 return HFA384X_PORTTYPE_HOSTAP;
323 }
324
325
hostap_set_encryption(local_info_t * local)326 int hostap_set_encryption(local_info_t *local)
327 {
328 u16 val, old_val;
329 int i, keylen, len, idx;
330 char keybuf[WEP_KEY_LEN + 1];
331 enum { NONE, WEP, OTHER } encrypt_type;
332
333 idx = local->crypt_info.tx_keyidx;
334 if (local->crypt_info.crypt[idx] == NULL ||
335 local->crypt_info.crypt[idx]->ops == NULL)
336 encrypt_type = NONE;
337 else if (strcmp(local->crypt_info.crypt[idx]->ops->name, "WEP") == 0)
338 encrypt_type = WEP;
339 else
340 encrypt_type = OTHER;
341
342 if (local->func->get_rid(local->dev, HFA384X_RID_CNFWEPFLAGS, &val, 2,
343 1) < 0) {
344 printk(KERN_DEBUG "Could not read current WEP flags.\n");
345 goto fail;
346 }
347 le16_to_cpus(&val);
348 old_val = val;
349
350 if (encrypt_type != NONE || local->privacy_invoked)
351 val |= HFA384X_WEPFLAGS_PRIVACYINVOKED;
352 else
353 val &= ~HFA384X_WEPFLAGS_PRIVACYINVOKED;
354
355 if (local->open_wep || encrypt_type == NONE ||
356 ((local->ieee_802_1x || local->wpa) && local->host_decrypt))
357 val &= ~HFA384X_WEPFLAGS_EXCLUDEUNENCRYPTED;
358 else
359 val |= HFA384X_WEPFLAGS_EXCLUDEUNENCRYPTED;
360
361 if ((encrypt_type != NONE || local->privacy_invoked) &&
362 (encrypt_type == OTHER || local->host_encrypt))
363 val |= HFA384X_WEPFLAGS_HOSTENCRYPT;
364 else
365 val &= ~HFA384X_WEPFLAGS_HOSTENCRYPT;
366 if ((encrypt_type != NONE || local->privacy_invoked) &&
367 (encrypt_type == OTHER || local->host_decrypt))
368 val |= HFA384X_WEPFLAGS_HOSTDECRYPT;
369 else
370 val &= ~HFA384X_WEPFLAGS_HOSTDECRYPT;
371
372 if (val != old_val &&
373 hostap_set_word(local->dev, HFA384X_RID_CNFWEPFLAGS, val)) {
374 printk(KERN_DEBUG "Could not write new WEP flags (0x%x)\n",
375 val);
376 goto fail;
377 }
378
379 if (encrypt_type != WEP)
380 return 0;
381
382 /* 104-bit support seems to require that all the keys are set to the
383 * same keylen */
384 keylen = 6; /* first 5 octets */
385 len = local->crypt_info.crypt[idx]->ops->get_key(keybuf, sizeof(keybuf), NULL,
386 local->crypt_info.crypt[idx]->priv);
387 if (idx >= 0 && idx < WEP_KEYS && len > 5)
388 keylen = WEP_KEY_LEN + 1; /* first 13 octets */
389
390 for (i = 0; i < WEP_KEYS; i++) {
391 memset(keybuf, 0, sizeof(keybuf));
392 if (local->crypt_info.crypt[i]) {
393 (void) local->crypt_info.crypt[i]->ops->get_key(
394 keybuf, sizeof(keybuf),
395 NULL, local->crypt_info.crypt[i]->priv);
396 }
397 if (local->func->set_rid(local->dev,
398 HFA384X_RID_CNFDEFAULTKEY0 + i,
399 keybuf, keylen)) {
400 printk(KERN_DEBUG "Could not set key %d (len=%d)\n",
401 i, keylen);
402 goto fail;
403 }
404 }
405 if (hostap_set_word(local->dev, HFA384X_RID_CNFWEPDEFAULTKEYID, idx)) {
406 printk(KERN_DEBUG "Could not set default keyid %d\n", idx);
407 goto fail;
408 }
409
410 return 0;
411
412 fail:
413 printk(KERN_DEBUG "%s: encryption setup failed\n", local->dev->name);
414 return -1;
415 }
416
417
hostap_set_antsel(local_info_t * local)418 int hostap_set_antsel(local_info_t *local)
419 {
420 u16 val;
421 int ret = 0;
422
423 if (local->antsel_tx != HOSTAP_ANTSEL_DO_NOT_TOUCH &&
424 local->func->cmd(local->dev, HFA384X_CMDCODE_READMIF,
425 HFA386X_CR_TX_CONFIGURE,
426 NULL, &val) == 0) {
427 val &= ~(BIT(2) | BIT(1));
428 switch (local->antsel_tx) {
429 case HOSTAP_ANTSEL_DIVERSITY:
430 val |= BIT(1);
431 break;
432 case HOSTAP_ANTSEL_LOW:
433 break;
434 case HOSTAP_ANTSEL_HIGH:
435 val |= BIT(2);
436 break;
437 }
438
439 if (local->func->cmd(local->dev, HFA384X_CMDCODE_WRITEMIF,
440 HFA386X_CR_TX_CONFIGURE, &val, NULL)) {
441 printk(KERN_INFO "%s: setting TX AntSel failed\n",
442 local->dev->name);
443 ret = -1;
444 }
445 }
446
447 if (local->antsel_rx != HOSTAP_ANTSEL_DO_NOT_TOUCH &&
448 local->func->cmd(local->dev, HFA384X_CMDCODE_READMIF,
449 HFA386X_CR_RX_CONFIGURE,
450 NULL, &val) == 0) {
451 val &= ~(BIT(1) | BIT(0));
452 switch (local->antsel_rx) {
453 case HOSTAP_ANTSEL_DIVERSITY:
454 break;
455 case HOSTAP_ANTSEL_LOW:
456 val |= BIT(0);
457 break;
458 case HOSTAP_ANTSEL_HIGH:
459 val |= BIT(0) | BIT(1);
460 break;
461 }
462
463 if (local->func->cmd(local->dev, HFA384X_CMDCODE_WRITEMIF,
464 HFA386X_CR_RX_CONFIGURE, &val, NULL)) {
465 printk(KERN_INFO "%s: setting RX AntSel failed\n",
466 local->dev->name);
467 ret = -1;
468 }
469 }
470
471 return ret;
472 }
473
474
hostap_set_roaming(local_info_t * local)475 int hostap_set_roaming(local_info_t *local)
476 {
477 u16 val;
478
479 switch (local->host_roaming) {
480 case 1:
481 val = HFA384X_ROAMING_HOST;
482 break;
483 case 2:
484 val = HFA384X_ROAMING_DISABLED;
485 break;
486 case 0:
487 default:
488 val = HFA384X_ROAMING_FIRMWARE;
489 break;
490 }
491
492 return hostap_set_word(local->dev, HFA384X_RID_CNFROAMINGMODE, val);
493 }
494
495
hostap_set_auth_algs(local_info_t * local)496 int hostap_set_auth_algs(local_info_t *local)
497 {
498 int val = local->auth_algs;
499 /* At least STA f/w v0.6.2 seems to have issues with cnfAuthentication
500 * set to include both Open and Shared Key flags. It tries to use
501 * Shared Key authentication in that case even if WEP keys are not
502 * configured.. STA f/w v0.7.6 is able to handle such configuration,
503 * but it is unknown when this was fixed between 0.6.2 .. 0.7.6. */
504 if (local->sta_fw_ver < PRISM2_FW_VER(0,7,0) &&
505 val != PRISM2_AUTH_OPEN && val != PRISM2_AUTH_SHARED_KEY)
506 val = PRISM2_AUTH_OPEN;
507
508 if (hostap_set_word(local->dev, HFA384X_RID_CNFAUTHENTICATION, val)) {
509 printk(KERN_INFO "%s: cnfAuthentication setting to 0x%x "
510 "failed\n", local->dev->name, local->auth_algs);
511 return -EINVAL;
512 }
513
514 return 0;
515 }
516
517
hostap_dump_rx_header(const char * name,const struct hfa384x_rx_frame * rx)518 void hostap_dump_rx_header(const char *name, const struct hfa384x_rx_frame *rx)
519 {
520 u16 status, fc;
521
522 status = __le16_to_cpu(rx->status);
523
524 printk(KERN_DEBUG "%s: RX status=0x%04x (port=%d, type=%d, "
525 "fcserr=%d) silence=%d signal=%d rate=%d rxflow=%d; "
526 "jiffies=%ld\n",
527 name, status, (status >> 8) & 0x07, status >> 13, status & 1,
528 rx->silence, rx->signal, rx->rate, rx->rxflow, jiffies);
529
530 fc = __le16_to_cpu(rx->frame_control);
531 printk(KERN_DEBUG " FC=0x%04x (type=%d:%d) dur=0x%04x seq=0x%04x "
532 "data_len=%d%s%s\n",
533 fc, (fc & IEEE80211_FCTL_FTYPE) >> 2,
534 (fc & IEEE80211_FCTL_STYPE) >> 4,
535 __le16_to_cpu(rx->duration_id), __le16_to_cpu(rx->seq_ctrl),
536 __le16_to_cpu(rx->data_len),
537 fc & IEEE80211_FCTL_TODS ? " [ToDS]" : "",
538 fc & IEEE80211_FCTL_FROMDS ? " [FromDS]" : "");
539
540 printk(KERN_DEBUG " A1=%pM A2=%pM A3=%pM A4=%pM\n",
541 rx->addr1, rx->addr2, rx->addr3, rx->addr4);
542
543 printk(KERN_DEBUG " dst=%pM src=%pM len=%d\n",
544 rx->dst_addr, rx->src_addr,
545 __be16_to_cpu(rx->len));
546 }
547
548
hostap_dump_tx_header(const char * name,const struct hfa384x_tx_frame * tx)549 void hostap_dump_tx_header(const char *name, const struct hfa384x_tx_frame *tx)
550 {
551 u16 fc;
552
553 printk(KERN_DEBUG "%s: TX status=0x%04x retry_count=%d tx_rate=%d "
554 "tx_control=0x%04x; jiffies=%ld\n",
555 name, __le16_to_cpu(tx->status), tx->retry_count, tx->tx_rate,
556 __le16_to_cpu(tx->tx_control), jiffies);
557
558 fc = __le16_to_cpu(tx->frame_control);
559 printk(KERN_DEBUG " FC=0x%04x (type=%d:%d) dur=0x%04x seq=0x%04x "
560 "data_len=%d%s%s\n",
561 fc, (fc & IEEE80211_FCTL_FTYPE) >> 2,
562 (fc & IEEE80211_FCTL_STYPE) >> 4,
563 __le16_to_cpu(tx->duration_id), __le16_to_cpu(tx->seq_ctrl),
564 __le16_to_cpu(tx->data_len),
565 fc & IEEE80211_FCTL_TODS ? " [ToDS]" : "",
566 fc & IEEE80211_FCTL_FROMDS ? " [FromDS]" : "");
567
568 printk(KERN_DEBUG " A1=%pM A2=%pM A3=%pM A4=%pM\n",
569 tx->addr1, tx->addr2, tx->addr3, tx->addr4);
570
571 printk(KERN_DEBUG " dst=%pM src=%pM len=%d\n",
572 tx->dst_addr, tx->src_addr,
573 __be16_to_cpu(tx->len));
574 }
575
576
hostap_80211_header_parse(const struct sk_buff * skb,unsigned char * haddr)577 static int hostap_80211_header_parse(const struct sk_buff *skb,
578 unsigned char *haddr)
579 {
580 memcpy(haddr, skb_mac_header(skb) + 10, ETH_ALEN); /* addr2 */
581 return ETH_ALEN;
582 }
583
584
hostap_80211_get_hdrlen(__le16 fc)585 int hostap_80211_get_hdrlen(__le16 fc)
586 {
587 if (ieee80211_is_data(fc) && ieee80211_has_a4 (fc))
588 return 30; /* Addr4 */
589 else if (ieee80211_is_cts(fc) || ieee80211_is_ack(fc))
590 return 10;
591 else if (ieee80211_is_ctl(fc))
592 return 16;
593
594 return 24;
595 }
596
597
prism2_close(struct net_device * dev)598 static int prism2_close(struct net_device *dev)
599 {
600 struct hostap_interface *iface;
601 local_info_t *local;
602
603 PDEBUG(DEBUG_FLOW, "%s: prism2_close\n", dev->name);
604
605 iface = netdev_priv(dev);
606 local = iface->local;
607
608 if (dev == local->ddev) {
609 prism2_sta_deauth(local, WLAN_REASON_DEAUTH_LEAVING);
610 }
611 #ifndef PRISM2_NO_KERNEL_IEEE80211_MGMT
612 if (!local->hostapd && dev == local->dev &&
613 (!local->func->card_present || local->func->card_present(local)) &&
614 local->hw_ready && local->ap && local->iw_mode == IW_MODE_MASTER)
615 hostap_deauth_all_stas(dev, local->ap, 1);
616 #endif /* PRISM2_NO_KERNEL_IEEE80211_MGMT */
617
618 if (dev == local->dev) {
619 local->func->hw_shutdown(dev, HOSTAP_HW_ENABLE_CMDCOMPL);
620 }
621
622 if (netif_running(dev)) {
623 netif_stop_queue(dev);
624 netif_device_detach(dev);
625 }
626
627 cancel_work_sync(&local->reset_queue);
628 cancel_work_sync(&local->set_multicast_list_queue);
629 cancel_work_sync(&local->set_tim_queue);
630 #ifndef PRISM2_NO_STATION_MODES
631 cancel_work_sync(&local->info_queue);
632 #endif
633 cancel_work_sync(&local->comms_qual_update);
634
635 module_put(local->hw_module);
636
637 local->num_dev_open--;
638
639 if (dev != local->dev && local->dev->flags & IFF_UP &&
640 local->master_dev_auto_open && local->num_dev_open == 1) {
641 /* Close master radio interface automatically if it was also
642 * opened automatically and we are now closing the last
643 * remaining non-master device. */
644 dev_close(local->dev);
645 }
646
647 return 0;
648 }
649
650
prism2_open(struct net_device * dev)651 static int prism2_open(struct net_device *dev)
652 {
653 struct hostap_interface *iface;
654 local_info_t *local;
655
656 PDEBUG(DEBUG_FLOW, "%s: prism2_open\n", dev->name);
657
658 iface = netdev_priv(dev);
659 local = iface->local;
660
661 if (local->no_pri) {
662 printk(KERN_DEBUG "%s: could not set interface UP - no PRI "
663 "f/w\n", dev->name);
664 return -ENODEV;
665 }
666
667 if ((local->func->card_present && !local->func->card_present(local)) ||
668 local->hw_downloading)
669 return -ENODEV;
670
671 if (!try_module_get(local->hw_module))
672 return -ENODEV;
673 local->num_dev_open++;
674
675 if (!local->dev_enabled && local->func->hw_enable(dev, 1)) {
676 printk(KERN_WARNING "%s: could not enable MAC port\n",
677 dev->name);
678 prism2_close(dev);
679 return -ENODEV;
680 }
681 if (!local->dev_enabled)
682 prism2_callback(local, PRISM2_CALLBACK_ENABLE);
683 local->dev_enabled = 1;
684
685 if (dev != local->dev && !(local->dev->flags & IFF_UP)) {
686 /* Master radio interface is needed for all operation, so open
687 * it automatically when any virtual net_device is opened. */
688 local->master_dev_auto_open = 1;
689 dev_open(local->dev, NULL);
690 }
691
692 netif_device_attach(dev);
693 netif_start_queue(dev);
694
695 return 0;
696 }
697
698
prism2_set_mac_address(struct net_device * dev,void * p)699 static int prism2_set_mac_address(struct net_device *dev, void *p)
700 {
701 struct hostap_interface *iface;
702 local_info_t *local;
703 struct list_head *ptr;
704 struct sockaddr *addr = p;
705
706 iface = netdev_priv(dev);
707 local = iface->local;
708
709 if (local->func->set_rid(dev, HFA384X_RID_CNFOWNMACADDR, addr->sa_data,
710 ETH_ALEN) < 0 || local->func->reset_port(dev))
711 return -EINVAL;
712
713 read_lock_bh(&local->iface_lock);
714 list_for_each(ptr, &local->hostap_interfaces) {
715 iface = list_entry(ptr, struct hostap_interface, list);
716 memcpy(iface->dev->dev_addr, addr->sa_data, ETH_ALEN);
717 }
718 memcpy(local->dev->dev_addr, addr->sa_data, ETH_ALEN);
719 read_unlock_bh(&local->iface_lock);
720
721 return 0;
722 }
723
724
725 /* TODO: to be further implemented as soon as Prism2 fully supports
726 * GroupAddresses and correct documentation is available */
hostap_set_multicast_list_queue(struct work_struct * work)727 void hostap_set_multicast_list_queue(struct work_struct *work)
728 {
729 local_info_t *local =
730 container_of(work, local_info_t, set_multicast_list_queue);
731 struct net_device *dev = local->dev;
732
733 if (hostap_set_word(dev, HFA384X_RID_PROMISCUOUSMODE,
734 local->is_promisc)) {
735 printk(KERN_INFO "%s: %sabling promiscuous mode failed\n",
736 dev->name, local->is_promisc ? "en" : "dis");
737 }
738 }
739
740
hostap_set_multicast_list(struct net_device * dev)741 static void hostap_set_multicast_list(struct net_device *dev)
742 {
743 #if 0
744 /* FIX: promiscuous mode seems to be causing a lot of problems with
745 * some station firmware versions (FCSErr frames, invalid MACPort, etc.
746 * corrupted incoming frames). This code is now commented out while the
747 * problems are investigated. */
748 struct hostap_interface *iface;
749 local_info_t *local;
750
751 iface = netdev_priv(dev);
752 local = iface->local;
753 if ((dev->flags & IFF_ALLMULTI) || (dev->flags & IFF_PROMISC)) {
754 local->is_promisc = 1;
755 } else {
756 local->is_promisc = 0;
757 }
758
759 schedule_work(&local->set_multicast_list_queue);
760 #endif
761 }
762
763
prism2_tx_timeout(struct net_device * dev,unsigned int txqueue)764 static void prism2_tx_timeout(struct net_device *dev, unsigned int txqueue)
765 {
766 struct hostap_interface *iface;
767 local_info_t *local;
768 struct hfa384x_regs regs;
769
770 iface = netdev_priv(dev);
771 local = iface->local;
772
773 printk(KERN_WARNING "%s Tx timed out! Resetting card\n", dev->name);
774 netif_stop_queue(local->dev);
775
776 local->func->read_regs(dev, ®s);
777 printk(KERN_DEBUG "%s: CMD=%04x EVSTAT=%04x "
778 "OFFSET0=%04x OFFSET1=%04x SWSUPPORT0=%04x\n",
779 dev->name, regs.cmd, regs.evstat, regs.offset0, regs.offset1,
780 regs.swsupport0);
781
782 local->func->schedule_reset(local);
783 }
784
785 const struct header_ops hostap_80211_ops = {
786 .create = eth_header,
787 .cache = eth_header_cache,
788 .cache_update = eth_header_cache_update,
789 .parse = hostap_80211_header_parse,
790 };
791 EXPORT_SYMBOL(hostap_80211_ops);
792
793
794 static const struct net_device_ops hostap_netdev_ops = {
795 .ndo_start_xmit = hostap_data_start_xmit,
796
797 .ndo_open = prism2_open,
798 .ndo_stop = prism2_close,
799 .ndo_do_ioctl = hostap_ioctl,
800 .ndo_set_mac_address = prism2_set_mac_address,
801 .ndo_set_rx_mode = hostap_set_multicast_list,
802 .ndo_tx_timeout = prism2_tx_timeout,
803 .ndo_validate_addr = eth_validate_addr,
804 };
805
806 static const struct net_device_ops hostap_mgmt_netdev_ops = {
807 .ndo_start_xmit = hostap_mgmt_start_xmit,
808
809 .ndo_open = prism2_open,
810 .ndo_stop = prism2_close,
811 .ndo_do_ioctl = hostap_ioctl,
812 .ndo_set_mac_address = prism2_set_mac_address,
813 .ndo_set_rx_mode = hostap_set_multicast_list,
814 .ndo_tx_timeout = prism2_tx_timeout,
815 .ndo_validate_addr = eth_validate_addr,
816 };
817
818 static const struct net_device_ops hostap_master_ops = {
819 .ndo_start_xmit = hostap_master_start_xmit,
820
821 .ndo_open = prism2_open,
822 .ndo_stop = prism2_close,
823 .ndo_do_ioctl = hostap_ioctl,
824 .ndo_set_mac_address = prism2_set_mac_address,
825 .ndo_set_rx_mode = hostap_set_multicast_list,
826 .ndo_tx_timeout = prism2_tx_timeout,
827 .ndo_validate_addr = eth_validate_addr,
828 };
829
hostap_setup_dev(struct net_device * dev,local_info_t * local,int type)830 void hostap_setup_dev(struct net_device *dev, local_info_t *local,
831 int type)
832 {
833 struct hostap_interface *iface;
834
835 iface = netdev_priv(dev);
836 ether_setup(dev);
837 dev->min_mtu = PRISM2_MIN_MTU;
838 dev->max_mtu = PRISM2_MAX_MTU;
839 dev->priv_flags &= ~IFF_TX_SKB_SHARING;
840
841 /* kernel callbacks */
842 if (iface) {
843 /* Currently, we point to the proper spy_data only on
844 * the main_dev. This could be fixed. Jean II */
845 iface->wireless_data.spy_data = &iface->spy_data;
846 dev->wireless_data = &iface->wireless_data;
847 }
848 dev->wireless_handlers = &hostap_iw_handler_def;
849 dev->watchdog_timeo = TX_TIMEOUT;
850
851 switch(type) {
852 case HOSTAP_INTERFACE_AP:
853 dev->priv_flags |= IFF_NO_QUEUE; /* use main radio device queue */
854 dev->netdev_ops = &hostap_mgmt_netdev_ops;
855 dev->type = ARPHRD_IEEE80211;
856 dev->header_ops = &hostap_80211_ops;
857 break;
858 case HOSTAP_INTERFACE_MASTER:
859 dev->netdev_ops = &hostap_master_ops;
860 break;
861 default:
862 dev->priv_flags |= IFF_NO_QUEUE; /* use main radio device queue */
863 dev->netdev_ops = &hostap_netdev_ops;
864 }
865
866 dev->mtu = local->mtu;
867
868
869 dev->ethtool_ops = &prism2_ethtool_ops;
870
871 }
872
hostap_enable_hostapd(local_info_t * local,int rtnl_locked)873 static int hostap_enable_hostapd(local_info_t *local, int rtnl_locked)
874 {
875 struct net_device *dev = local->dev;
876
877 if (local->apdev)
878 return -EEXIST;
879
880 printk(KERN_DEBUG "%s: enabling hostapd mode\n", dev->name);
881
882 local->apdev = hostap_add_interface(local, HOSTAP_INTERFACE_AP,
883 rtnl_locked, local->ddev->name,
884 "ap");
885 if (local->apdev == NULL)
886 return -ENOMEM;
887
888 return 0;
889 }
890
891
hostap_disable_hostapd(local_info_t * local,int rtnl_locked)892 static int hostap_disable_hostapd(local_info_t *local, int rtnl_locked)
893 {
894 struct net_device *dev = local->dev;
895
896 printk(KERN_DEBUG "%s: disabling hostapd mode\n", dev->name);
897
898 hostap_remove_interface(local->apdev, rtnl_locked, 1);
899 local->apdev = NULL;
900
901 return 0;
902 }
903
904
hostap_enable_hostapd_sta(local_info_t * local,int rtnl_locked)905 static int hostap_enable_hostapd_sta(local_info_t *local, int rtnl_locked)
906 {
907 struct net_device *dev = local->dev;
908
909 if (local->stadev)
910 return -EEXIST;
911
912 printk(KERN_DEBUG "%s: enabling hostapd STA mode\n", dev->name);
913
914 local->stadev = hostap_add_interface(local, HOSTAP_INTERFACE_STA,
915 rtnl_locked, local->ddev->name,
916 "sta");
917 if (local->stadev == NULL)
918 return -ENOMEM;
919
920 return 0;
921 }
922
923
hostap_disable_hostapd_sta(local_info_t * local,int rtnl_locked)924 static int hostap_disable_hostapd_sta(local_info_t *local, int rtnl_locked)
925 {
926 struct net_device *dev = local->dev;
927
928 printk(KERN_DEBUG "%s: disabling hostapd mode\n", dev->name);
929
930 hostap_remove_interface(local->stadev, rtnl_locked, 1);
931 local->stadev = NULL;
932
933 return 0;
934 }
935
936
hostap_set_hostapd(local_info_t * local,int val,int rtnl_locked)937 int hostap_set_hostapd(local_info_t *local, int val, int rtnl_locked)
938 {
939 int ret;
940
941 if (val < 0 || val > 1)
942 return -EINVAL;
943
944 if (local->hostapd == val)
945 return 0;
946
947 if (val) {
948 ret = hostap_enable_hostapd(local, rtnl_locked);
949 if (ret == 0)
950 local->hostapd = 1;
951 } else {
952 local->hostapd = 0;
953 ret = hostap_disable_hostapd(local, rtnl_locked);
954 if (ret != 0)
955 local->hostapd = 1;
956 }
957
958 return ret;
959 }
960
961
hostap_set_hostapd_sta(local_info_t * local,int val,int rtnl_locked)962 int hostap_set_hostapd_sta(local_info_t *local, int val, int rtnl_locked)
963 {
964 int ret;
965
966 if (val < 0 || val > 1)
967 return -EINVAL;
968
969 if (local->hostapd_sta == val)
970 return 0;
971
972 if (val) {
973 ret = hostap_enable_hostapd_sta(local, rtnl_locked);
974 if (ret == 0)
975 local->hostapd_sta = 1;
976 } else {
977 local->hostapd_sta = 0;
978 ret = hostap_disable_hostapd_sta(local, rtnl_locked);
979 if (ret != 0)
980 local->hostapd_sta = 1;
981 }
982
983
984 return ret;
985 }
986
987
prism2_update_comms_qual(struct net_device * dev)988 int prism2_update_comms_qual(struct net_device *dev)
989 {
990 struct hostap_interface *iface;
991 local_info_t *local;
992 int ret = 0;
993 struct hfa384x_comms_quality sq;
994
995 iface = netdev_priv(dev);
996 local = iface->local;
997 if (!local->sta_fw_ver)
998 ret = -1;
999 else if (local->sta_fw_ver >= PRISM2_FW_VER(1,3,1)) {
1000 if (local->func->get_rid(local->dev,
1001 HFA384X_RID_DBMCOMMSQUALITY,
1002 &sq, sizeof(sq), 1) >= 0) {
1003 local->comms_qual = (s16) le16_to_cpu(sq.comm_qual);
1004 local->avg_signal = (s16) le16_to_cpu(sq.signal_level);
1005 local->avg_noise = (s16) le16_to_cpu(sq.noise_level);
1006 local->last_comms_qual_update = jiffies;
1007 } else
1008 ret = -1;
1009 } else {
1010 if (local->func->get_rid(local->dev, HFA384X_RID_COMMSQUALITY,
1011 &sq, sizeof(sq), 1) >= 0) {
1012 local->comms_qual = le16_to_cpu(sq.comm_qual);
1013 local->avg_signal = HFA384X_LEVEL_TO_dBm(
1014 le16_to_cpu(sq.signal_level));
1015 local->avg_noise = HFA384X_LEVEL_TO_dBm(
1016 le16_to_cpu(sq.noise_level));
1017 local->last_comms_qual_update = jiffies;
1018 } else
1019 ret = -1;
1020 }
1021
1022 return ret;
1023 }
1024
1025
prism2_sta_send_mgmt(local_info_t * local,u8 * dst,u16 stype,u8 * body,size_t bodylen)1026 int prism2_sta_send_mgmt(local_info_t *local, u8 *dst, u16 stype,
1027 u8 *body, size_t bodylen)
1028 {
1029 struct sk_buff *skb;
1030 struct hostap_ieee80211_mgmt *mgmt;
1031 struct hostap_skb_tx_data *meta;
1032 struct net_device *dev = local->dev;
1033
1034 skb = dev_alloc_skb(IEEE80211_MGMT_HDR_LEN + bodylen);
1035 if (skb == NULL)
1036 return -ENOMEM;
1037
1038 mgmt = skb_put_zero(skb, IEEE80211_MGMT_HDR_LEN);
1039 mgmt->frame_control = cpu_to_le16(IEEE80211_FTYPE_MGMT | stype);
1040 memcpy(mgmt->da, dst, ETH_ALEN);
1041 memcpy(mgmt->sa, dev->dev_addr, ETH_ALEN);
1042 memcpy(mgmt->bssid, dst, ETH_ALEN);
1043 if (body)
1044 skb_put_data(skb, body, bodylen);
1045
1046 meta = (struct hostap_skb_tx_data *) skb->cb;
1047 memset(meta, 0, sizeof(*meta));
1048 meta->magic = HOSTAP_SKB_TX_DATA_MAGIC;
1049 meta->iface = netdev_priv(dev);
1050
1051 skb->dev = dev;
1052 skb_reset_mac_header(skb);
1053 skb_reset_network_header(skb);
1054 dev_queue_xmit(skb);
1055
1056 return 0;
1057 }
1058
1059
prism2_sta_deauth(local_info_t * local,u16 reason)1060 int prism2_sta_deauth(local_info_t *local, u16 reason)
1061 {
1062 union iwreq_data wrqu;
1063 int ret;
1064 __le16 val = cpu_to_le16(reason);
1065
1066 if (local->iw_mode != IW_MODE_INFRA ||
1067 is_zero_ether_addr(local->bssid) ||
1068 ether_addr_equal(local->bssid, "\x44\x44\x44\x44\x44\x44"))
1069 return 0;
1070
1071 ret = prism2_sta_send_mgmt(local, local->bssid, IEEE80211_STYPE_DEAUTH,
1072 (u8 *) &val, 2);
1073 eth_zero_addr(wrqu.ap_addr.sa_data);
1074 wireless_send_event(local->dev, SIOCGIWAP, &wrqu, NULL);
1075 return ret;
1076 }
1077
1078
1079 struct proc_dir_entry *hostap_proc;
1080
hostap_init(void)1081 static int __init hostap_init(void)
1082 {
1083 if (init_net.proc_net != NULL) {
1084 hostap_proc = proc_mkdir("hostap", init_net.proc_net);
1085 if (!hostap_proc)
1086 printk(KERN_WARNING "Failed to mkdir "
1087 "/proc/net/hostap\n");
1088 } else
1089 hostap_proc = NULL;
1090
1091 return 0;
1092 }
1093
1094
hostap_exit(void)1095 static void __exit hostap_exit(void)
1096 {
1097 if (hostap_proc != NULL) {
1098 hostap_proc = NULL;
1099 remove_proc_entry("hostap", init_net.proc_net);
1100 }
1101 }
1102
1103
1104 EXPORT_SYMBOL(hostap_set_word);
1105 EXPORT_SYMBOL(hostap_set_string);
1106 EXPORT_SYMBOL(hostap_get_porttype);
1107 EXPORT_SYMBOL(hostap_set_encryption);
1108 EXPORT_SYMBOL(hostap_set_antsel);
1109 EXPORT_SYMBOL(hostap_set_roaming);
1110 EXPORT_SYMBOL(hostap_set_auth_algs);
1111 EXPORT_SYMBOL(hostap_dump_rx_header);
1112 EXPORT_SYMBOL(hostap_dump_tx_header);
1113 EXPORT_SYMBOL(hostap_80211_get_hdrlen);
1114 EXPORT_SYMBOL(hostap_setup_dev);
1115 EXPORT_SYMBOL(hostap_set_multicast_list_queue);
1116 EXPORT_SYMBOL(hostap_set_hostapd);
1117 EXPORT_SYMBOL(hostap_set_hostapd_sta);
1118 EXPORT_SYMBOL(hostap_add_interface);
1119 EXPORT_SYMBOL(hostap_remove_interface);
1120 EXPORT_SYMBOL(prism2_update_comms_qual);
1121
1122 module_init(hostap_init);
1123 module_exit(hostap_exit);
1124