3 Broadcom BCM43xx wireless driver
5 Copyright (c) 2005 Martin Langer <martin-langer@gmx.de>,
6 Stefano Brivio <st3@riseup.net>
7 Michael Buesch <mbuesch@freenet.de>
8 Danny van Dyk <kugelfang@gentoo.org>
9 Andreas Jaggi <andreas.jaggi@waterwave.ch>
11 Some parts of the code in this file are derived from the ipw2200
12 driver Copyright(c) 2003 - 2004 Intel Corporation.
14 This program is free software; you can redistribute it and/or modify
15 it under the terms of the GNU General Public License as published by
16 the Free Software Foundation; either version 2 of the License, or
17 (at your option) any later version.
19 This program is distributed in the hope that it will be useful,
20 but WITHOUT ANY WARRANTY; without even the implied warranty of
21 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
22 GNU General Public License for more details.
24 You should have received a copy of the GNU General Public License
25 along with this program; see the file COPYING. If not, write to
26 the Free Software Foundation, Inc., 51 Franklin Steet, Fifth Floor,
27 Boston, MA 02110-1301, USA.
31 #include <linux/delay.h>
32 #include <linux/init.h>
33 #include <linux/moduleparam.h>
34 #include <linux/if_arp.h>
35 #include <linux/etherdevice.h>
36 #include <linux/version.h>
37 #include <linux/firmware.h>
38 #include <linux/wireless.h>
39 #include <linux/workqueue.h>
40 #include <linux/skbuff.h>
41 #include <linux/dma-mapping.h>
42 #include <net/iw_handler.h>
45 #include "bcm43xx_main.h"
46 #include "bcm43xx_debugfs.h"
47 #include "bcm43xx_radio.h"
48 #include "bcm43xx_phy.h"
49 #include "bcm43xx_dma.h"
50 #include "bcm43xx_pio.h"
51 #include "bcm43xx_power.h"
52 #include "bcm43xx_wx.h"
53 #include "bcm43xx_ethtool.h"
54 #include "bcm43xx_xmit.h"
55 #include "bcm43xx_sysfs.h"
58 MODULE_DESCRIPTION("Broadcom BCM43xx wireless driver");
59 MODULE_AUTHOR("Martin Langer");
60 MODULE_AUTHOR("Stefano Brivio");
61 MODULE_AUTHOR("Michael Buesch");
62 MODULE_LICENSE("GPL");
64 #ifdef CONFIG_BCM947XX
65 extern char *nvram_get(char *name);
68 #if defined(CONFIG_BCM43XX_DMA) && defined(CONFIG_BCM43XX_PIO)
69 static int modparam_pio;
70 module_param_named(pio, modparam_pio, int, 0444);
71 MODULE_PARM_DESC(pio, "enable(1) / disable(0) PIO mode");
72 #elif defined(CONFIG_BCM43XX_DMA)
73 # define modparam_pio 0
74 #elif defined(CONFIG_BCM43XX_PIO)
75 # define modparam_pio 1
78 static int modparam_bad_frames_preempt;
79 module_param_named(bad_frames_preempt, modparam_bad_frames_preempt, int, 0444);
80 MODULE_PARM_DESC(bad_frames_preempt, "enable(1) / disable(0) Bad Frames Preemption");
82 static int modparam_short_retry = BCM43xx_DEFAULT_SHORT_RETRY_LIMIT;
83 module_param_named(short_retry, modparam_short_retry, int, 0444);
84 MODULE_PARM_DESC(short_retry, "Short-Retry-Limit (0 - 15)");
86 static int modparam_long_retry = BCM43xx_DEFAULT_LONG_RETRY_LIMIT;
87 module_param_named(long_retry, modparam_long_retry, int, 0444);
88 MODULE_PARM_DESC(long_retry, "Long-Retry-Limit (0 - 15)");
90 static int modparam_locale = -1;
91 module_param_named(locale, modparam_locale, int, 0444);
92 MODULE_PARM_DESC(country, "Select LocaleCode 0-11 (For travelers)");
94 static int modparam_noleds;
95 module_param_named(noleds, modparam_noleds, int, 0444);
96 MODULE_PARM_DESC(noleds, "Turn off all LED activity");
98 #ifdef CONFIG_BCM43XX_DEBUG
99 static char modparam_fwpostfix[64];
100 module_param_string(fwpostfix, modparam_fwpostfix, 64, 0444);
101 MODULE_PARM_DESC(fwpostfix, "Postfix for .fw files. Useful for debugging.");
103 # define modparam_fwpostfix ""
104 #endif /* CONFIG_BCM43XX_DEBUG*/
107 /* If you want to debug with just a single device, enable this,
108 * where the string is the pci device ID (as given by the kernel's
109 * pci_name function) of the device to be used.
111 //#define DEBUG_SINGLE_DEVICE_ONLY "0001:11:00.0"
113 /* If you want to enable printing of each MMIO access, enable this. */
114 //#define DEBUG_ENABLE_MMIO_PRINT
116 /* If you want to enable printing of MMIO access within
117 * ucode/pcm upload, initvals write, enable this.
119 //#define DEBUG_ENABLE_UCODE_MMIO_PRINT
121 /* If you want to enable printing of PCI Config Space access, enable this */
122 //#define DEBUG_ENABLE_PCILOG
125 /* Detailed list maintained at:
126 * http://openfacts.berlios.de/index-en.phtml?title=Bcm43xxDevices
128 static struct pci_device_id bcm43xx_pci_tbl[] = {
129 /* Broadcom 4303 802.11b */
130 { PCI_VENDOR_ID_BROADCOM, 0x4301, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0 },
131 /* Broadcom 4307 802.11b */
132 { PCI_VENDOR_ID_BROADCOM, 0x4307, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0 },
133 /* Broadcom 4318 802.11b/g */
134 { PCI_VENDOR_ID_BROADCOM, 0x4318, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0 },
135 /* Broadcom 4319 802.11a/b/g */
136 { PCI_VENDOR_ID_BROADCOM, 0x4319, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0 },
137 /* Broadcom 4306 802.11b/g */
138 { PCI_VENDOR_ID_BROADCOM, 0x4320, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0 },
139 /* Broadcom 4306 802.11a */
140 // { PCI_VENDOR_ID_BROADCOM, 0x4321, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0 },
141 /* Broadcom 4309 802.11a/b/g */
142 { PCI_VENDOR_ID_BROADCOM, 0x4324, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0 },
143 /* Broadcom 43XG 802.11b/g */
144 { PCI_VENDOR_ID_BROADCOM, 0x4325, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0 },
145 #ifdef CONFIG_BCM947XX
146 /* SB bus on BCM947xx */
147 { PCI_VENDOR_ID_BROADCOM, 0x0800, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0 },
151 MODULE_DEVICE_TABLE(pci, bcm43xx_pci_tbl);
153 static void bcm43xx_ram_write(struct bcm43xx_private *bcm, u16 offset, u32 val)
157 status = bcm43xx_read32(bcm, BCM43xx_MMIO_STATUS_BITFIELD);
158 if (!(status & BCM43xx_SBF_XFER_REG_BYTESWAP))
161 bcm43xx_write32(bcm, BCM43xx_MMIO_RAM_CONTROL, offset);
163 bcm43xx_write32(bcm, BCM43xx_MMIO_RAM_DATA, val);
167 void bcm43xx_shm_control_word(struct bcm43xx_private *bcm,
168 u16 routing, u16 offset)
172 /* "offset" is the WORD offset. */
177 bcm43xx_write32(bcm, BCM43xx_MMIO_SHM_CONTROL, control);
180 u32 bcm43xx_shm_read32(struct bcm43xx_private *bcm,
181 u16 routing, u16 offset)
185 if (routing == BCM43xx_SHM_SHARED) {
186 if (offset & 0x0003) {
187 /* Unaligned access */
188 bcm43xx_shm_control_word(bcm, routing, offset >> 2);
189 ret = bcm43xx_read16(bcm, BCM43xx_MMIO_SHM_DATA_UNALIGNED);
191 bcm43xx_shm_control_word(bcm, routing, (offset >> 2) + 1);
192 ret |= bcm43xx_read16(bcm, BCM43xx_MMIO_SHM_DATA);
198 bcm43xx_shm_control_word(bcm, routing, offset);
199 ret = bcm43xx_read32(bcm, BCM43xx_MMIO_SHM_DATA);
204 u16 bcm43xx_shm_read16(struct bcm43xx_private *bcm,
205 u16 routing, u16 offset)
209 if (routing == BCM43xx_SHM_SHARED) {
210 if (offset & 0x0003) {
211 /* Unaligned access */
212 bcm43xx_shm_control_word(bcm, routing, offset >> 2);
213 ret = bcm43xx_read16(bcm, BCM43xx_MMIO_SHM_DATA_UNALIGNED);
219 bcm43xx_shm_control_word(bcm, routing, offset);
220 ret = bcm43xx_read16(bcm, BCM43xx_MMIO_SHM_DATA);
225 void bcm43xx_shm_write32(struct bcm43xx_private *bcm,
226 u16 routing, u16 offset,
229 if (routing == BCM43xx_SHM_SHARED) {
230 if (offset & 0x0003) {
231 /* Unaligned access */
232 bcm43xx_shm_control_word(bcm, routing, offset >> 2);
234 bcm43xx_write16(bcm, BCM43xx_MMIO_SHM_DATA_UNALIGNED,
235 (value >> 16) & 0xffff);
237 bcm43xx_shm_control_word(bcm, routing, (offset >> 2) + 1);
239 bcm43xx_write16(bcm, BCM43xx_MMIO_SHM_DATA,
245 bcm43xx_shm_control_word(bcm, routing, offset);
247 bcm43xx_write32(bcm, BCM43xx_MMIO_SHM_DATA, value);
250 void bcm43xx_shm_write16(struct bcm43xx_private *bcm,
251 u16 routing, u16 offset,
254 if (routing == BCM43xx_SHM_SHARED) {
255 if (offset & 0x0003) {
256 /* Unaligned access */
257 bcm43xx_shm_control_word(bcm, routing, offset >> 2);
259 bcm43xx_write16(bcm, BCM43xx_MMIO_SHM_DATA_UNALIGNED,
265 bcm43xx_shm_control_word(bcm, routing, offset);
267 bcm43xx_write16(bcm, BCM43xx_MMIO_SHM_DATA, value);
270 void bcm43xx_tsf_read(struct bcm43xx_private *bcm, u64 *tsf)
272 /* We need to be careful. As we read the TSF from multiple
273 * registers, we should take care of register overflows.
274 * In theory, the whole tsf read process should be atomic.
275 * We try to be atomic here, by restaring the read process,
276 * if any of the high registers changed (overflew).
278 if (bcm->current_core->rev >= 3) {
279 u32 low, high, high2;
282 high = bcm43xx_read32(bcm, BCM43xx_MMIO_REV3PLUS_TSF_HIGH);
283 low = bcm43xx_read32(bcm, BCM43xx_MMIO_REV3PLUS_TSF_LOW);
284 high2 = bcm43xx_read32(bcm, BCM43xx_MMIO_REV3PLUS_TSF_HIGH);
285 } while (unlikely(high != high2));
293 u16 test1, test2, test3;
296 v3 = bcm43xx_read16(bcm, BCM43xx_MMIO_TSF_3);
297 v2 = bcm43xx_read16(bcm, BCM43xx_MMIO_TSF_2);
298 v1 = bcm43xx_read16(bcm, BCM43xx_MMIO_TSF_1);
299 v0 = bcm43xx_read16(bcm, BCM43xx_MMIO_TSF_0);
301 test3 = bcm43xx_read16(bcm, BCM43xx_MMIO_TSF_3);
302 test2 = bcm43xx_read16(bcm, BCM43xx_MMIO_TSF_2);
303 test1 = bcm43xx_read16(bcm, BCM43xx_MMIO_TSF_1);
304 } while (v3 != test3 || v2 != test2 || v1 != test1);
318 void bcm43xx_tsf_write(struct bcm43xx_private *bcm, u64 tsf)
322 status = bcm43xx_read32(bcm, BCM43xx_MMIO_STATUS_BITFIELD);
323 status |= BCM43xx_SBF_TIME_UPDATE;
324 bcm43xx_write32(bcm, BCM43xx_MMIO_STATUS_BITFIELD, status);
327 /* Be careful with the in-progress timer.
328 * First zero out the low register, so we have a full
329 * register-overflow duration to complete the operation.
331 if (bcm->current_core->rev >= 3) {
332 u32 lo = (tsf & 0x00000000FFFFFFFFULL);
333 u32 hi = (tsf & 0xFFFFFFFF00000000ULL) >> 32;
335 bcm43xx_write32(bcm, BCM43xx_MMIO_REV3PLUS_TSF_LOW, 0);
337 bcm43xx_write32(bcm, BCM43xx_MMIO_REV3PLUS_TSF_HIGH, hi);
339 bcm43xx_write32(bcm, BCM43xx_MMIO_REV3PLUS_TSF_LOW, lo);
341 u16 v0 = (tsf & 0x000000000000FFFFULL);
342 u16 v1 = (tsf & 0x00000000FFFF0000ULL) >> 16;
343 u16 v2 = (tsf & 0x0000FFFF00000000ULL) >> 32;
344 u16 v3 = (tsf & 0xFFFF000000000000ULL) >> 48;
346 bcm43xx_write16(bcm, BCM43xx_MMIO_TSF_0, 0);
348 bcm43xx_write16(bcm, BCM43xx_MMIO_TSF_3, v3);
350 bcm43xx_write16(bcm, BCM43xx_MMIO_TSF_2, v2);
352 bcm43xx_write16(bcm, BCM43xx_MMIO_TSF_1, v1);
354 bcm43xx_write16(bcm, BCM43xx_MMIO_TSF_0, v0);
357 status = bcm43xx_read32(bcm, BCM43xx_MMIO_STATUS_BITFIELD);
358 status &= ~BCM43xx_SBF_TIME_UPDATE;
359 bcm43xx_write32(bcm, BCM43xx_MMIO_STATUS_BITFIELD, status);
363 void bcm43xx_macfilter_set(struct bcm43xx_private *bcm,
370 bcm43xx_write16(bcm, BCM43xx_MMIO_MACFILTER_CONTROL, offset);
374 bcm43xx_write16(bcm, BCM43xx_MMIO_MACFILTER_DATA, data);
377 bcm43xx_write16(bcm, BCM43xx_MMIO_MACFILTER_DATA, data);
380 bcm43xx_write16(bcm, BCM43xx_MMIO_MACFILTER_DATA, data);
383 static void bcm43xx_macfilter_clear(struct bcm43xx_private *bcm,
386 const u8 zero_addr[ETH_ALEN] = { 0 };
388 bcm43xx_macfilter_set(bcm, offset, zero_addr);
391 static void bcm43xx_write_mac_bssid_templates(struct bcm43xx_private *bcm)
393 const u8 *mac = (const u8 *)(bcm->net_dev->dev_addr);
394 const u8 *bssid = (const u8 *)(bcm->ieee->bssid);
395 u8 mac_bssid[ETH_ALEN * 2];
398 memcpy(mac_bssid, mac, ETH_ALEN);
399 memcpy(mac_bssid + ETH_ALEN, bssid, ETH_ALEN);
401 /* Write our MAC address and BSSID to template ram */
402 for (i = 0; i < ARRAY_SIZE(mac_bssid); i += sizeof(u32))
403 bcm43xx_ram_write(bcm, 0x20 + i, *((u32 *)(mac_bssid + i)));
404 for (i = 0; i < ARRAY_SIZE(mac_bssid); i += sizeof(u32))
405 bcm43xx_ram_write(bcm, 0x78 + i, *((u32 *)(mac_bssid + i)));
406 for (i = 0; i < ARRAY_SIZE(mac_bssid); i += sizeof(u32))
407 bcm43xx_ram_write(bcm, 0x478 + i, *((u32 *)(mac_bssid + i)));
410 //FIXME: Well, we should probably call them from somewhere.
412 static void bcm43xx_set_slot_time(struct bcm43xx_private *bcm, u16 slot_time)
414 /* slot_time is in usec. */
415 if (bcm43xx_current_phy(bcm)->type != BCM43xx_PHYTYPE_G)
417 bcm43xx_write16(bcm, 0x684, 510 + slot_time);
418 bcm43xx_shm_write16(bcm, BCM43xx_SHM_SHARED, 0x0010, slot_time);
421 static void bcm43xx_short_slot_timing_enable(struct bcm43xx_private *bcm)
423 bcm43xx_set_slot_time(bcm, 9);
426 static void bcm43xx_short_slot_timing_disable(struct bcm43xx_private *bcm)
428 bcm43xx_set_slot_time(bcm, 20);
432 /* FIXME: To get the MAC-filter working, we need to implement the
433 * following functions (and rename them :)
436 static void bcm43xx_disassociate(struct bcm43xx_private *bcm)
438 bcm43xx_mac_suspend(bcm);
439 bcm43xx_macfilter_clear(bcm, BCM43xx_MACFILTER_ASSOC);
441 bcm43xx_ram_write(bcm, 0x0026, 0x0000);
442 bcm43xx_ram_write(bcm, 0x0028, 0x0000);
443 bcm43xx_ram_write(bcm, 0x007E, 0x0000);
444 bcm43xx_ram_write(bcm, 0x0080, 0x0000);
445 bcm43xx_ram_write(bcm, 0x047E, 0x0000);
446 bcm43xx_ram_write(bcm, 0x0480, 0x0000);
448 if (bcm->current_core->rev < 3) {
449 bcm43xx_write16(bcm, 0x0610, 0x8000);
450 bcm43xx_write16(bcm, 0x060E, 0x0000);
452 bcm43xx_write32(bcm, 0x0188, 0x80000000);
454 bcm43xx_shm_write32(bcm, BCM43xx_SHM_WIRELESS, 0x0004, 0x000003ff);
456 if (bcm43xx_current_phy(bcm)->type == BCM43xx_PHYTYPE_G &&
457 ieee80211_is_ofdm_rate(bcm->softmac->txrates.default_rate))
458 bcm43xx_short_slot_timing_enable(bcm);
460 bcm43xx_mac_enable(bcm);
463 static void bcm43xx_associate(struct bcm43xx_private *bcm,
466 memcpy(bcm->ieee->bssid, mac, ETH_ALEN);
468 bcm43xx_mac_suspend(bcm);
469 bcm43xx_macfilter_set(bcm, BCM43xx_MACFILTER_ASSOC, mac);
470 bcm43xx_write_mac_bssid_templates(bcm);
471 bcm43xx_mac_enable(bcm);
475 /* Enable a Generic IRQ. "mask" is the mask of which IRQs to enable.
476 * Returns the _previously_ enabled IRQ mask.
478 static inline u32 bcm43xx_interrupt_enable(struct bcm43xx_private *bcm, u32 mask)
482 old_mask = bcm43xx_read32(bcm, BCM43xx_MMIO_GEN_IRQ_MASK);
483 bcm43xx_write32(bcm, BCM43xx_MMIO_GEN_IRQ_MASK, old_mask | mask);
488 /* Disable a Generic IRQ. "mask" is the mask of which IRQs to disable.
489 * Returns the _previously_ enabled IRQ mask.
491 static inline u32 bcm43xx_interrupt_disable(struct bcm43xx_private *bcm, u32 mask)
495 old_mask = bcm43xx_read32(bcm, BCM43xx_MMIO_GEN_IRQ_MASK);
496 bcm43xx_write32(bcm, BCM43xx_MMIO_GEN_IRQ_MASK, old_mask & ~mask);
501 /* Synchronize IRQ top- and bottom-half.
502 * IRQs must be masked before calling this.
503 * This must not be called with the irq_lock held.
505 static void bcm43xx_synchronize_irq(struct bcm43xx_private *bcm)
507 synchronize_irq(bcm->irq);
508 tasklet_disable(&bcm->isr_tasklet);
511 /* Make sure we don't receive more data from the device. */
512 static int bcm43xx_disable_interrupts_sync(struct bcm43xx_private *bcm, u32 *oldstate)
517 spin_lock_irqsave(&bcm->irq_lock, flags);
518 if (unlikely(bcm43xx_status(bcm) != BCM43xx_STAT_INITIALIZED)) {
519 spin_unlock_irqrestore(&bcm->irq_lock, flags);
522 old = bcm43xx_interrupt_disable(bcm, BCM43xx_IRQ_ALL);
523 spin_unlock_irqrestore(&bcm->irq_lock, flags);
524 bcm43xx_synchronize_irq(bcm);
532 static int bcm43xx_read_radioinfo(struct bcm43xx_private *bcm)
534 struct bcm43xx_radioinfo *radio = bcm43xx_current_radio(bcm);
535 struct bcm43xx_phyinfo *phy = bcm43xx_current_phy(bcm);
542 if (bcm->chip_id == 0x4317) {
543 if (bcm->chip_rev == 0x00)
544 radio_id = 0x3205017F;
545 else if (bcm->chip_rev == 0x01)
546 radio_id = 0x4205017F;
548 radio_id = 0x5205017F;
550 bcm43xx_write16(bcm, BCM43xx_MMIO_RADIO_CONTROL, BCM43xx_RADIOCTL_ID);
551 radio_id = bcm43xx_read16(bcm, BCM43xx_MMIO_RADIO_DATA_HIGH);
553 bcm43xx_write16(bcm, BCM43xx_MMIO_RADIO_CONTROL, BCM43xx_RADIOCTL_ID);
554 radio_id |= bcm43xx_read16(bcm, BCM43xx_MMIO_RADIO_DATA_LOW);
557 manufact = (radio_id & 0x00000FFF);
558 version = (radio_id & 0x0FFFF000) >> 12;
559 revision = (radio_id & 0xF0000000) >> 28;
561 dprintk(KERN_INFO PFX "Detected Radio: ID: %x (Manuf: %x Ver: %x Rev: %x)\n",
562 radio_id, manufact, version, revision);
565 case BCM43xx_PHYTYPE_A:
566 if ((version != 0x2060) || (revision != 1) || (manufact != 0x17f))
567 goto err_unsupported_radio;
569 case BCM43xx_PHYTYPE_B:
570 if ((version & 0xFFF0) != 0x2050)
571 goto err_unsupported_radio;
573 case BCM43xx_PHYTYPE_G:
574 if (version != 0x2050)
575 goto err_unsupported_radio;
579 radio->manufact = manufact;
580 radio->version = version;
581 radio->revision = revision;
583 /* Set default attenuation values. */
584 radio->baseband_atten = bcm43xx_default_baseband_attenuation(bcm);
585 radio->radio_atten = bcm43xx_default_radio_attenuation(bcm);
586 radio->txctl1 = bcm43xx_default_txctl1(bcm);
587 radio->txctl2 = 0xFFFF;
588 if (phy->type == BCM43xx_PHYTYPE_A)
589 radio->txpower_desired = bcm->sprom.maxpower_aphy;
591 radio->txpower_desired = bcm->sprom.maxpower_bgphy;
593 /* Initialize the in-memory nrssi Lookup Table. */
594 for (i = 0; i < 64; i++)
595 radio->nrssi_lt[i] = i;
599 err_unsupported_radio:
600 printk(KERN_ERR PFX "Unsupported Radio connected to the PHY!\n");
604 static const char * bcm43xx_locale_iso(u8 locale)
606 /* ISO 3166-1 country codes.
607 * Note that there aren't ISO 3166-1 codes for
608 * all or locales. (Not all locales are countries)
611 case BCM43xx_LOCALE_WORLD:
612 case BCM43xx_LOCALE_ALL:
614 case BCM43xx_LOCALE_THAILAND:
616 case BCM43xx_LOCALE_ISRAEL:
618 case BCM43xx_LOCALE_JORDAN:
620 case BCM43xx_LOCALE_CHINA:
622 case BCM43xx_LOCALE_JAPAN:
623 case BCM43xx_LOCALE_JAPAN_HIGH:
625 case BCM43xx_LOCALE_USA_CANADA_ANZ:
626 case BCM43xx_LOCALE_USA_LOW:
628 case BCM43xx_LOCALE_EUROPE:
630 case BCM43xx_LOCALE_NONE:
637 static const char * bcm43xx_locale_string(u8 locale)
640 case BCM43xx_LOCALE_WORLD:
642 case BCM43xx_LOCALE_THAILAND:
644 case BCM43xx_LOCALE_ISRAEL:
646 case BCM43xx_LOCALE_JORDAN:
648 case BCM43xx_LOCALE_CHINA:
650 case BCM43xx_LOCALE_JAPAN:
652 case BCM43xx_LOCALE_USA_CANADA_ANZ:
653 return "USA/Canada/ANZ";
654 case BCM43xx_LOCALE_EUROPE:
656 case BCM43xx_LOCALE_USA_LOW:
658 case BCM43xx_LOCALE_JAPAN_HIGH:
660 case BCM43xx_LOCALE_ALL:
662 case BCM43xx_LOCALE_NONE:
669 static inline u8 bcm43xx_crc8(u8 crc, u8 data)
671 static const u8 t[] = {
672 0x00, 0xF7, 0xB9, 0x4E, 0x25, 0xD2, 0x9C, 0x6B,
673 0x4A, 0xBD, 0xF3, 0x04, 0x6F, 0x98, 0xD6, 0x21,
674 0x94, 0x63, 0x2D, 0xDA, 0xB1, 0x46, 0x08, 0xFF,
675 0xDE, 0x29, 0x67, 0x90, 0xFB, 0x0C, 0x42, 0xB5,
676 0x7F, 0x88, 0xC6, 0x31, 0x5A, 0xAD, 0xE3, 0x14,
677 0x35, 0xC2, 0x8C, 0x7B, 0x10, 0xE7, 0xA9, 0x5E,
678 0xEB, 0x1C, 0x52, 0xA5, 0xCE, 0x39, 0x77, 0x80,
679 0xA1, 0x56, 0x18, 0xEF, 0x84, 0x73, 0x3D, 0xCA,
680 0xFE, 0x09, 0x47, 0xB0, 0xDB, 0x2C, 0x62, 0x95,
681 0xB4, 0x43, 0x0D, 0xFA, 0x91, 0x66, 0x28, 0xDF,
682 0x6A, 0x9D, 0xD3, 0x24, 0x4F, 0xB8, 0xF6, 0x01,
683 0x20, 0xD7, 0x99, 0x6E, 0x05, 0xF2, 0xBC, 0x4B,
684 0x81, 0x76, 0x38, 0xCF, 0xA4, 0x53, 0x1D, 0xEA,
685 0xCB, 0x3C, 0x72, 0x85, 0xEE, 0x19, 0x57, 0xA0,
686 0x15, 0xE2, 0xAC, 0x5B, 0x30, 0xC7, 0x89, 0x7E,
687 0x5F, 0xA8, 0xE6, 0x11, 0x7A, 0x8D, 0xC3, 0x34,
688 0xAB, 0x5C, 0x12, 0xE5, 0x8E, 0x79, 0x37, 0xC0,
689 0xE1, 0x16, 0x58, 0xAF, 0xC4, 0x33, 0x7D, 0x8A,
690 0x3F, 0xC8, 0x86, 0x71, 0x1A, 0xED, 0xA3, 0x54,
691 0x75, 0x82, 0xCC, 0x3B, 0x50, 0xA7, 0xE9, 0x1E,
692 0xD4, 0x23, 0x6D, 0x9A, 0xF1, 0x06, 0x48, 0xBF,
693 0x9E, 0x69, 0x27, 0xD0, 0xBB, 0x4C, 0x02, 0xF5,
694 0x40, 0xB7, 0xF9, 0x0E, 0x65, 0x92, 0xDC, 0x2B,
695 0x0A, 0xFD, 0xB3, 0x44, 0x2F, 0xD8, 0x96, 0x61,
696 0x55, 0xA2, 0xEC, 0x1B, 0x70, 0x87, 0xC9, 0x3E,
697 0x1F, 0xE8, 0xA6, 0x51, 0x3A, 0xCD, 0x83, 0x74,
698 0xC1, 0x36, 0x78, 0x8F, 0xE4, 0x13, 0x5D, 0xAA,
699 0x8B, 0x7C, 0x32, 0xC5, 0xAE, 0x59, 0x17, 0xE0,
700 0x2A, 0xDD, 0x93, 0x64, 0x0F, 0xF8, 0xB6, 0x41,
701 0x60, 0x97, 0xD9, 0x2E, 0x45, 0xB2, 0xFC, 0x0B,
702 0xBE, 0x49, 0x07, 0xF0, 0x9B, 0x6C, 0x22, 0xD5,
703 0xF4, 0x03, 0x4D, 0xBA, 0xD1, 0x26, 0x68, 0x9F,
705 return t[crc ^ data];
708 static u8 bcm43xx_sprom_crc(const u16 *sprom)
713 for (word = 0; word < BCM43xx_SPROM_SIZE - 1; word++) {
714 crc = bcm43xx_crc8(crc, sprom[word] & 0x00FF);
715 crc = bcm43xx_crc8(crc, (sprom[word] & 0xFF00) >> 8);
717 crc = bcm43xx_crc8(crc, sprom[BCM43xx_SPROM_VERSION] & 0x00FF);
723 int bcm43xx_sprom_read(struct bcm43xx_private *bcm, u16 *sprom)
726 u8 crc, expected_crc;
728 for (i = 0; i < BCM43xx_SPROM_SIZE; i++)
729 sprom[i] = bcm43xx_read16(bcm, BCM43xx_SPROM_BASE + (i * 2));
731 crc = bcm43xx_sprom_crc(sprom);
732 expected_crc = (sprom[BCM43xx_SPROM_VERSION] & 0xFF00) >> 8;
733 if (crc != expected_crc) {
734 printk(KERN_WARNING PFX "WARNING: Invalid SPROM checksum "
735 "(0x%02X, expected: 0x%02X)\n",
743 int bcm43xx_sprom_write(struct bcm43xx_private *bcm, const u16 *sprom)
746 u8 crc, expected_crc;
749 /* CRC-8 validation of the input data. */
750 crc = bcm43xx_sprom_crc(sprom);
751 expected_crc = (sprom[BCM43xx_SPROM_VERSION] & 0xFF00) >> 8;
752 if (crc != expected_crc) {
753 printk(KERN_ERR PFX "SPROM input data: Invalid CRC\n");
757 printk(KERN_INFO PFX "Writing SPROM. Do NOT turn off the power! Please stand by...\n");
758 err = bcm43xx_pci_read_config32(bcm, BCM43xx_PCICFG_SPROMCTL, &spromctl);
761 spromctl |= 0x10; /* SPROM WRITE enable. */
762 bcm43xx_pci_write_config32(bcm, BCM43xx_PCICFG_SPROMCTL, spromctl);
765 /* We must burn lots of CPU cycles here, but that does not
766 * really matter as one does not write the SPROM every other minute...
768 printk(KERN_INFO PFX "[ 0%%");
770 for (i = 0; i < BCM43xx_SPROM_SIZE; i++) {
779 bcm43xx_write16(bcm, BCM43xx_SPROM_BASE + (i * 2), sprom[i]);
783 spromctl &= ~0x10; /* SPROM WRITE enable. */
784 bcm43xx_pci_write_config32(bcm, BCM43xx_PCICFG_SPROMCTL, spromctl);
789 printk(KERN_INFO PFX "SPROM written.\n");
790 bcm43xx_controller_restart(bcm, "SPROM update");
794 printk(KERN_ERR PFX "Could not access SPROM control register.\n");
798 static int bcm43xx_sprom_extract(struct bcm43xx_private *bcm)
802 #ifdef CONFIG_BCM947XX
806 sprom = kzalloc(BCM43xx_SPROM_SIZE * sizeof(u16),
809 printk(KERN_ERR PFX "sprom_extract OOM\n");
812 #ifdef CONFIG_BCM947XX
813 sprom[BCM43xx_SPROM_BOARDFLAGS2] = atoi(nvram_get("boardflags2"));
814 sprom[BCM43xx_SPROM_BOARDFLAGS] = atoi(nvram_get("boardflags"));
816 if ((c = nvram_get("il0macaddr")) != NULL)
817 e_aton(c, (char *) &(sprom[BCM43xx_SPROM_IL0MACADDR]));
819 if ((c = nvram_get("et1macaddr")) != NULL)
820 e_aton(c, (char *) &(sprom[BCM43xx_SPROM_ET1MACADDR]));
822 sprom[BCM43xx_SPROM_PA0B0] = atoi(nvram_get("pa0b0"));
823 sprom[BCM43xx_SPROM_PA0B1] = atoi(nvram_get("pa0b1"));
824 sprom[BCM43xx_SPROM_PA0B2] = atoi(nvram_get("pa0b2"));
826 sprom[BCM43xx_SPROM_PA1B0] = atoi(nvram_get("pa1b0"));
827 sprom[BCM43xx_SPROM_PA1B1] = atoi(nvram_get("pa1b1"));
828 sprom[BCM43xx_SPROM_PA1B2] = atoi(nvram_get("pa1b2"));
830 sprom[BCM43xx_SPROM_BOARDREV] = atoi(nvram_get("boardrev"));
832 bcm43xx_sprom_read(bcm, sprom);
836 value = sprom[BCM43xx_SPROM_BOARDFLAGS2];
837 bcm->sprom.boardflags2 = value;
840 value = sprom[BCM43xx_SPROM_IL0MACADDR + 0];
841 *(((u16 *)bcm->sprom.il0macaddr) + 0) = cpu_to_be16(value);
842 value = sprom[BCM43xx_SPROM_IL0MACADDR + 1];
843 *(((u16 *)bcm->sprom.il0macaddr) + 1) = cpu_to_be16(value);
844 value = sprom[BCM43xx_SPROM_IL0MACADDR + 2];
845 *(((u16 *)bcm->sprom.il0macaddr) + 2) = cpu_to_be16(value);
848 value = sprom[BCM43xx_SPROM_ET0MACADDR + 0];
849 *(((u16 *)bcm->sprom.et0macaddr) + 0) = cpu_to_be16(value);
850 value = sprom[BCM43xx_SPROM_ET0MACADDR + 1];
851 *(((u16 *)bcm->sprom.et0macaddr) + 1) = cpu_to_be16(value);
852 value = sprom[BCM43xx_SPROM_ET0MACADDR + 2];
853 *(((u16 *)bcm->sprom.et0macaddr) + 2) = cpu_to_be16(value);
856 value = sprom[BCM43xx_SPROM_ET1MACADDR + 0];
857 *(((u16 *)bcm->sprom.et1macaddr) + 0) = cpu_to_be16(value);
858 value = sprom[BCM43xx_SPROM_ET1MACADDR + 1];
859 *(((u16 *)bcm->sprom.et1macaddr) + 1) = cpu_to_be16(value);
860 value = sprom[BCM43xx_SPROM_ET1MACADDR + 2];
861 *(((u16 *)bcm->sprom.et1macaddr) + 2) = cpu_to_be16(value);
863 /* ethernet phy settings */
864 value = sprom[BCM43xx_SPROM_ETHPHY];
865 bcm->sprom.et0phyaddr = (value & 0x001F);
866 bcm->sprom.et1phyaddr = (value & 0x03E0) >> 5;
867 bcm->sprom.et0mdcport = (value & (1 << 14)) >> 14;
868 bcm->sprom.et1mdcport = (value & (1 << 15)) >> 15;
870 /* boardrev, antennas, locale */
871 value = sprom[BCM43xx_SPROM_BOARDREV];
872 bcm->sprom.boardrev = (value & 0x00FF);
873 bcm->sprom.locale = (value & 0x0F00) >> 8;
874 bcm->sprom.antennas_aphy = (value & 0x3000) >> 12;
875 bcm->sprom.antennas_bgphy = (value & 0xC000) >> 14;
876 if (modparam_locale != -1) {
877 if (modparam_locale >= 0 && modparam_locale <= 11) {
878 bcm->sprom.locale = modparam_locale;
879 printk(KERN_WARNING PFX "Operating with modified "
880 "LocaleCode %u (%s)\n",
882 bcm43xx_locale_string(bcm->sprom.locale));
884 printk(KERN_WARNING PFX "Module parameter \"locale\" "
885 "invalid value. (0 - 11)\n");
890 value = sprom[BCM43xx_SPROM_PA0B0];
891 bcm->sprom.pa0b0 = value;
892 value = sprom[BCM43xx_SPROM_PA0B1];
893 bcm->sprom.pa0b1 = value;
894 value = sprom[BCM43xx_SPROM_PA0B2];
895 bcm->sprom.pa0b2 = value;
898 value = sprom[BCM43xx_SPROM_WL0GPIO0];
901 bcm->sprom.wl0gpio0 = value & 0x00FF;
902 bcm->sprom.wl0gpio1 = (value & 0xFF00) >> 8;
903 value = sprom[BCM43xx_SPROM_WL0GPIO2];
906 bcm->sprom.wl0gpio2 = value & 0x00FF;
907 bcm->sprom.wl0gpio3 = (value & 0xFF00) >> 8;
910 value = sprom[BCM43xx_SPROM_MAXPWR];
911 bcm->sprom.maxpower_aphy = (value & 0xFF00) >> 8;
912 bcm->sprom.maxpower_bgphy = value & 0x00FF;
915 value = sprom[BCM43xx_SPROM_PA1B0];
916 bcm->sprom.pa1b0 = value;
917 value = sprom[BCM43xx_SPROM_PA1B1];
918 bcm->sprom.pa1b1 = value;
919 value = sprom[BCM43xx_SPROM_PA1B2];
920 bcm->sprom.pa1b2 = value;
922 /* idle tssi target */
923 value = sprom[BCM43xx_SPROM_IDL_TSSI_TGT];
924 bcm->sprom.idle_tssi_tgt_aphy = value & 0x00FF;
925 bcm->sprom.idle_tssi_tgt_bgphy = (value & 0xFF00) >> 8;
928 value = sprom[BCM43xx_SPROM_BOARDFLAGS];
931 bcm->sprom.boardflags = value;
932 /* boardflags workarounds */
933 if (bcm->board_vendor == PCI_VENDOR_ID_DELL &&
934 bcm->chip_id == 0x4301 &&
935 bcm->board_revision == 0x74)
936 bcm->sprom.boardflags |= BCM43xx_BFL_BTCOEXIST;
937 if (bcm->board_vendor == PCI_VENDOR_ID_APPLE &&
938 bcm->board_type == 0x4E &&
939 bcm->board_revision > 0x40)
940 bcm->sprom.boardflags |= BCM43xx_BFL_PACTRL;
943 value = sprom[BCM43xx_SPROM_ANTENNA_GAIN];
944 if (value == 0x0000 || value == 0xFFFF)
946 /* convert values to Q5.2 */
947 bcm->sprom.antennagain_aphy = ((value & 0xFF00) >> 8) * 4;
948 bcm->sprom.antennagain_bgphy = (value & 0x00FF) * 4;
955 static int bcm43xx_geo_init(struct bcm43xx_private *bcm)
957 struct ieee80211_geo *geo;
958 struct ieee80211_channel *chan;
959 int have_a = 0, have_bg = 0;
962 struct bcm43xx_phyinfo *phy;
963 const char *iso_country;
965 geo = kzalloc(sizeof(*geo), GFP_KERNEL);
969 for (i = 0; i < bcm->nr_80211_available; i++) {
970 phy = &(bcm->core_80211_ext[i].phy);
972 case BCM43xx_PHYTYPE_B:
973 case BCM43xx_PHYTYPE_G:
976 case BCM43xx_PHYTYPE_A:
983 iso_country = bcm43xx_locale_iso(bcm->sprom.locale);
986 for (i = 0, channel = IEEE80211_52GHZ_MIN_CHANNEL;
987 channel <= IEEE80211_52GHZ_MAX_CHANNEL; channel++) {
989 chan->freq = bcm43xx_channel_to_freq_a(channel);
990 chan->channel = channel;
995 for (i = 0, channel = IEEE80211_24GHZ_MIN_CHANNEL;
996 channel <= IEEE80211_24GHZ_MAX_CHANNEL; channel++) {
997 chan = &geo->bg[i++];
998 chan->freq = bcm43xx_channel_to_freq_bg(channel);
999 chan->channel = channel;
1001 geo->bg_channels = i;
1003 memcpy(geo->name, iso_country, 2);
1004 if (0 /*TODO: Outdoor use only */)
1006 else if (0 /*TODO: Indoor use only */)
1010 geo->name[3] = '\0';
1012 ieee80211_set_geo(bcm->ieee, geo);
1018 /* DummyTransmission function, as documented on
1019 * http://bcm-specs.sipsolutions.net/DummyTransmission
1021 void bcm43xx_dummy_transmission(struct bcm43xx_private *bcm)
1023 struct bcm43xx_phyinfo *phy = bcm43xx_current_phy(bcm);
1024 struct bcm43xx_radioinfo *radio = bcm43xx_current_radio(bcm);
1025 unsigned int i, max_loop;
1035 switch (phy->type) {
1036 case BCM43xx_PHYTYPE_A:
1038 buffer[0] = 0xCC010200;
1040 case BCM43xx_PHYTYPE_B:
1041 case BCM43xx_PHYTYPE_G:
1043 buffer[0] = 0x6E840B00;
1050 for (i = 0; i < 5; i++)
1051 bcm43xx_ram_write(bcm, i * 4, buffer[i]);
1053 bcm43xx_read32(bcm, BCM43xx_MMIO_STATUS_BITFIELD); /* dummy read */
1055 bcm43xx_write16(bcm, 0x0568, 0x0000);
1056 bcm43xx_write16(bcm, 0x07C0, 0x0000);
1057 bcm43xx_write16(bcm, 0x050C, ((phy->type == BCM43xx_PHYTYPE_A) ? 1 : 0));
1058 bcm43xx_write16(bcm, 0x0508, 0x0000);
1059 bcm43xx_write16(bcm, 0x050A, 0x0000);
1060 bcm43xx_write16(bcm, 0x054C, 0x0000);
1061 bcm43xx_write16(bcm, 0x056A, 0x0014);
1062 bcm43xx_write16(bcm, 0x0568, 0x0826);
1063 bcm43xx_write16(bcm, 0x0500, 0x0000);
1064 bcm43xx_write16(bcm, 0x0502, 0x0030);
1066 if (radio->version == 0x2050 && radio->revision <= 0x5)
1067 bcm43xx_radio_write16(bcm, 0x0051, 0x0017);
1068 for (i = 0x00; i < max_loop; i++) {
1069 value = bcm43xx_read16(bcm, 0x050E);
1074 for (i = 0x00; i < 0x0A; i++) {
1075 value = bcm43xx_read16(bcm, 0x050E);
1080 for (i = 0x00; i < 0x0A; i++) {
1081 value = bcm43xx_read16(bcm, 0x0690);
1082 if (!(value & 0x0100))
1086 if (radio->version == 0x2050 && radio->revision <= 0x5)
1087 bcm43xx_radio_write16(bcm, 0x0051, 0x0037);
1090 static void key_write(struct bcm43xx_private *bcm,
1091 u8 index, u8 algorithm, const u16 *key)
1093 unsigned int i, basic_wep = 0;
1097 /* Write associated key information */
1098 bcm43xx_shm_write16(bcm, BCM43xx_SHM_SHARED, 0x100 + (index * 2),
1099 ((index << 4) | (algorithm & 0x0F)));
1101 /* The first 4 WEP keys need extra love */
1102 if (((algorithm == BCM43xx_SEC_ALGO_WEP) ||
1103 (algorithm == BCM43xx_SEC_ALGO_WEP104)) && (index < 4))
1106 /* Write key payload, 8 little endian words */
1107 offset = bcm->security_offset + (index * BCM43xx_SEC_KEYSIZE);
1108 for (i = 0; i < (BCM43xx_SEC_KEYSIZE / sizeof(u16)); i++) {
1109 value = cpu_to_le16(key[i]);
1110 bcm43xx_shm_write16(bcm, BCM43xx_SHM_SHARED,
1111 offset + (i * 2), value);
1116 bcm43xx_shm_write16(bcm, BCM43xx_SHM_SHARED,
1117 offset + (i * 2) + 4 * BCM43xx_SEC_KEYSIZE,
1122 static void keymac_write(struct bcm43xx_private *bcm,
1123 u8 index, const u32 *addr)
1125 /* for keys 0-3 there is no associated mac address */
1130 if (bcm->current_core->rev >= 5) {
1131 bcm43xx_shm_write32(bcm,
1134 cpu_to_be32(*addr));
1135 bcm43xx_shm_write16(bcm,
1138 cpu_to_be16(*((u16 *)(addr + 1))));
1141 TODO(); /* Put them in the macaddress filter */
1144 /* Put them BCM43xx_SHM_SHARED, stating index 0x0120.
1145 Keep in mind to update the count of keymacs in 0x003E as well! */
1150 static int bcm43xx_key_write(struct bcm43xx_private *bcm,
1151 u8 index, u8 algorithm,
1152 const u8 *_key, int key_len,
1155 u8 key[BCM43xx_SEC_KEYSIZE] = { 0 };
1157 if (index >= ARRAY_SIZE(bcm->key))
1159 if (key_len > ARRAY_SIZE(key))
1161 if (algorithm < 1 || algorithm > 5)
1164 memcpy(key, _key, key_len);
1165 key_write(bcm, index, algorithm, (const u16 *)key);
1166 keymac_write(bcm, index, (const u32 *)mac_addr);
1168 bcm->key[index].algorithm = algorithm;
1173 static void bcm43xx_clear_keys(struct bcm43xx_private *bcm)
1175 static const u32 zero_mac[2] = { 0 };
1176 unsigned int i,j, nr_keys = 54;
1179 if (bcm->current_core->rev < 5)
1181 assert(nr_keys <= ARRAY_SIZE(bcm->key));
1183 for (i = 0; i < nr_keys; i++) {
1184 bcm->key[i].enabled = 0;
1185 /* returns for i < 4 immediately */
1186 keymac_write(bcm, i, zero_mac);
1187 bcm43xx_shm_write16(bcm, BCM43xx_SHM_SHARED,
1188 0x100 + (i * 2), 0x0000);
1189 for (j = 0; j < 8; j++) {
1190 offset = bcm->security_offset + (j * 4) + (i * BCM43xx_SEC_KEYSIZE);
1191 bcm43xx_shm_write16(bcm, BCM43xx_SHM_SHARED,
1195 dprintk(KERN_INFO PFX "Keys cleared\n");
1198 /* Lowlevel core-switch function. This is only to be used in
1199 * bcm43xx_switch_core() and bcm43xx_probe_cores()
1201 static int _switch_core(struct bcm43xx_private *bcm, int core)
1209 err = bcm43xx_pci_write_config32(bcm, BCM43xx_PCICFG_ACTIVE_CORE,
1210 (core * 0x1000) + 0x18000000);
1213 err = bcm43xx_pci_read_config32(bcm, BCM43xx_PCICFG_ACTIVE_CORE,
1217 current_core = (current_core - 0x18000000) / 0x1000;
1218 if (current_core == core)
1221 if (unlikely(attempts++ > BCM43xx_SWITCH_CORE_MAX_RETRIES))
1225 #ifdef CONFIG_BCM947XX
1226 if (bcm->pci_dev->bus->number == 0)
1227 bcm->current_core_offset = 0x1000 * core;
1229 bcm->current_core_offset = 0;
1234 printk(KERN_ERR PFX "Failed to switch to core %d\n", core);
1238 int bcm43xx_switch_core(struct bcm43xx_private *bcm, struct bcm43xx_coreinfo *new_core)
1242 if (unlikely(!new_core))
1244 if (!new_core->available)
1246 if (bcm->current_core == new_core)
1248 err = _switch_core(bcm, new_core->index);
1252 bcm->current_core = new_core;
1253 bcm->current_80211_core_idx = -1;
1254 if (new_core->id == BCM43xx_COREID_80211)
1255 bcm->current_80211_core_idx = (int)(new_core - &(bcm->core_80211[0]));
1261 static int bcm43xx_core_enabled(struct bcm43xx_private *bcm)
1265 value = bcm43xx_read32(bcm, BCM43xx_CIR_SBTMSTATELOW);
1266 value &= BCM43xx_SBTMSTATELOW_CLOCK | BCM43xx_SBTMSTATELOW_RESET
1267 | BCM43xx_SBTMSTATELOW_REJECT;
1269 return (value == BCM43xx_SBTMSTATELOW_CLOCK);
1272 /* disable current core */
1273 static int bcm43xx_core_disable(struct bcm43xx_private *bcm, u32 core_flags)
1279 /* fetch sbtmstatelow from core information registers */
1280 sbtmstatelow = bcm43xx_read32(bcm, BCM43xx_CIR_SBTMSTATELOW);
1282 /* core is already in reset */
1283 if (sbtmstatelow & BCM43xx_SBTMSTATELOW_RESET)
1286 if (sbtmstatelow & BCM43xx_SBTMSTATELOW_CLOCK) {
1287 sbtmstatelow = BCM43xx_SBTMSTATELOW_CLOCK |
1288 BCM43xx_SBTMSTATELOW_REJECT;
1289 bcm43xx_write32(bcm, BCM43xx_CIR_SBTMSTATELOW, sbtmstatelow);
1291 for (i = 0; i < 1000; i++) {
1292 sbtmstatelow = bcm43xx_read32(bcm, BCM43xx_CIR_SBTMSTATELOW);
1293 if (sbtmstatelow & BCM43xx_SBTMSTATELOW_REJECT) {
1300 printk(KERN_ERR PFX "Error: core_disable() REJECT timeout!\n");
1304 for (i = 0; i < 1000; i++) {
1305 sbtmstatehigh = bcm43xx_read32(bcm, BCM43xx_CIR_SBTMSTATEHIGH);
1306 if (!(sbtmstatehigh & BCM43xx_SBTMSTATEHIGH_BUSY)) {
1313 printk(KERN_ERR PFX "Error: core_disable() BUSY timeout!\n");
1317 sbtmstatelow = BCM43xx_SBTMSTATELOW_FORCE_GATE_CLOCK |
1318 BCM43xx_SBTMSTATELOW_REJECT |
1319 BCM43xx_SBTMSTATELOW_RESET |
1320 BCM43xx_SBTMSTATELOW_CLOCK |
1322 bcm43xx_write32(bcm, BCM43xx_CIR_SBTMSTATELOW, sbtmstatelow);
1326 sbtmstatelow = BCM43xx_SBTMSTATELOW_RESET |
1327 BCM43xx_SBTMSTATELOW_REJECT |
1329 bcm43xx_write32(bcm, BCM43xx_CIR_SBTMSTATELOW, sbtmstatelow);
1332 bcm->current_core->enabled = 0;
1337 /* enable (reset) current core */
1338 static int bcm43xx_core_enable(struct bcm43xx_private *bcm, u32 core_flags)
1345 err = bcm43xx_core_disable(bcm, core_flags);
1349 sbtmstatelow = BCM43xx_SBTMSTATELOW_CLOCK |
1350 BCM43xx_SBTMSTATELOW_RESET |
1351 BCM43xx_SBTMSTATELOW_FORCE_GATE_CLOCK |
1353 bcm43xx_write32(bcm, BCM43xx_CIR_SBTMSTATELOW, sbtmstatelow);
1356 sbtmstatehigh = bcm43xx_read32(bcm, BCM43xx_CIR_SBTMSTATEHIGH);
1357 if (sbtmstatehigh & BCM43xx_SBTMSTATEHIGH_SERROR) {
1358 sbtmstatehigh = 0x00000000;
1359 bcm43xx_write32(bcm, BCM43xx_CIR_SBTMSTATEHIGH, sbtmstatehigh);
1362 sbimstate = bcm43xx_read32(bcm, BCM43xx_CIR_SBIMSTATE);
1363 if (sbimstate & (BCM43xx_SBIMSTATE_IB_ERROR | BCM43xx_SBIMSTATE_TIMEOUT)) {
1364 sbimstate &= ~(BCM43xx_SBIMSTATE_IB_ERROR | BCM43xx_SBIMSTATE_TIMEOUT);
1365 bcm43xx_write32(bcm, BCM43xx_CIR_SBIMSTATE, sbimstate);
1368 sbtmstatelow = BCM43xx_SBTMSTATELOW_CLOCK |
1369 BCM43xx_SBTMSTATELOW_FORCE_GATE_CLOCK |
1371 bcm43xx_write32(bcm, BCM43xx_CIR_SBTMSTATELOW, sbtmstatelow);
1374 sbtmstatelow = BCM43xx_SBTMSTATELOW_CLOCK | core_flags;
1375 bcm43xx_write32(bcm, BCM43xx_CIR_SBTMSTATELOW, sbtmstatelow);
1378 bcm->current_core->enabled = 1;
1384 /* http://bcm-specs.sipsolutions.net/80211CoreReset */
1385 void bcm43xx_wireless_core_reset(struct bcm43xx_private *bcm, int connect_phy)
1387 u32 flags = 0x00040000;
1389 if ((bcm43xx_core_enabled(bcm)) &&
1390 !bcm43xx_using_pio(bcm)) {
1391 //FIXME: Do we _really_ want #ifndef CONFIG_BCM947XX here?
1392 #ifndef CONFIG_BCM947XX
1393 /* reset all used DMA controllers. */
1394 bcm43xx_dmacontroller_tx_reset(bcm, BCM43xx_MMIO_DMA1_BASE);
1395 bcm43xx_dmacontroller_tx_reset(bcm, BCM43xx_MMIO_DMA2_BASE);
1396 bcm43xx_dmacontroller_tx_reset(bcm, BCM43xx_MMIO_DMA3_BASE);
1397 bcm43xx_dmacontroller_tx_reset(bcm, BCM43xx_MMIO_DMA4_BASE);
1398 bcm43xx_dmacontroller_rx_reset(bcm, BCM43xx_MMIO_DMA1_BASE);
1399 if (bcm->current_core->rev < 5)
1400 bcm43xx_dmacontroller_rx_reset(bcm, BCM43xx_MMIO_DMA4_BASE);
1403 if (bcm43xx_status(bcm) == BCM43xx_STAT_SHUTTINGDOWN) {
1404 bcm43xx_write32(bcm, BCM43xx_MMIO_STATUS_BITFIELD,
1405 bcm43xx_read32(bcm, BCM43xx_MMIO_STATUS_BITFIELD)
1406 & ~(BCM43xx_SBF_MAC_ENABLED | 0x00000002));
1409 flags |= 0x20000000;
1410 bcm43xx_phy_connect(bcm, connect_phy);
1411 bcm43xx_core_enable(bcm, flags);
1412 bcm43xx_write16(bcm, 0x03E6, 0x0000);
1413 bcm43xx_write32(bcm, BCM43xx_MMIO_STATUS_BITFIELD,
1414 bcm43xx_read32(bcm, BCM43xx_MMIO_STATUS_BITFIELD)
1419 static void bcm43xx_wireless_core_disable(struct bcm43xx_private *bcm)
1421 bcm43xx_radio_turn_off(bcm);
1422 bcm43xx_write16(bcm, 0x03E6, 0x00F4);
1423 bcm43xx_core_disable(bcm, 0);
1426 /* Mark the current 80211 core inactive.
1427 * "active_80211_core" is the other 80211 core, which is used.
1429 static int bcm43xx_wireless_core_mark_inactive(struct bcm43xx_private *bcm,
1430 struct bcm43xx_coreinfo *active_80211_core)
1433 struct bcm43xx_coreinfo *old_core;
1436 bcm43xx_interrupt_disable(bcm, BCM43xx_IRQ_ALL);
1437 bcm43xx_radio_turn_off(bcm);
1438 sbtmstatelow = bcm43xx_read32(bcm, BCM43xx_CIR_SBTMSTATELOW);
1439 sbtmstatelow &= ~0x200a0000;
1440 sbtmstatelow |= 0xa0000;
1441 bcm43xx_write32(bcm, BCM43xx_CIR_SBTMSTATELOW, sbtmstatelow);
1443 sbtmstatelow = bcm43xx_read32(bcm, BCM43xx_CIR_SBTMSTATELOW);
1444 sbtmstatelow &= ~0xa0000;
1445 sbtmstatelow |= 0x80000;
1446 bcm43xx_write32(bcm, BCM43xx_CIR_SBTMSTATELOW, sbtmstatelow);
1449 if (bcm43xx_current_phy(bcm)->type == BCM43xx_PHYTYPE_G) {
1450 old_core = bcm->current_core;
1451 err = bcm43xx_switch_core(bcm, active_80211_core);
1454 sbtmstatelow = bcm43xx_read32(bcm, BCM43xx_CIR_SBTMSTATELOW);
1455 sbtmstatelow &= ~0x20000000;
1456 sbtmstatelow |= 0x20000000;
1457 bcm43xx_write32(bcm, BCM43xx_CIR_SBTMSTATELOW, sbtmstatelow);
1458 err = bcm43xx_switch_core(bcm, old_core);
1465 static void handle_irq_transmit_status(struct bcm43xx_private *bcm)
1469 struct bcm43xx_xmitstatus stat;
1472 v0 = bcm43xx_read32(bcm, BCM43xx_MMIO_XMITSTAT_0);
1475 v1 = bcm43xx_read32(bcm, BCM43xx_MMIO_XMITSTAT_1);
1477 stat.cookie = (v0 >> 16) & 0x0000FFFF;
1478 tmp = (u16)((v0 & 0xFFF0) | ((v0 & 0xF) >> 1));
1479 stat.flags = tmp & 0xFF;
1480 stat.cnt1 = (tmp & 0x0F00) >> 8;
1481 stat.cnt2 = (tmp & 0xF000) >> 12;
1482 stat.seq = (u16)(v1 & 0xFFFF);
1483 stat.unknown = (u16)((v1 >> 16) & 0xFF);
1485 bcm43xx_debugfs_log_txstat(bcm, &stat);
1487 if (stat.flags & BCM43xx_TXSTAT_FLAG_IGNORE)
1489 if (!(stat.flags & BCM43xx_TXSTAT_FLAG_ACK)) {
1490 //TODO: packet was not acked (was lost)
1492 //TODO: There are more (unknown) flags to test. see bcm43xx_main.h
1494 if (bcm43xx_using_pio(bcm))
1495 bcm43xx_pio_handle_xmitstatus(bcm, &stat);
1497 bcm43xx_dma_handle_xmitstatus(bcm, &stat);
1501 static void bcm43xx_generate_noise_sample(struct bcm43xx_private *bcm)
1503 bcm43xx_shm_write16(bcm, BCM43xx_SHM_SHARED, 0x408, 0x7F7F);
1504 bcm43xx_shm_write16(bcm, BCM43xx_SHM_SHARED, 0x40A, 0x7F7F);
1505 bcm43xx_write32(bcm, BCM43xx_MMIO_STATUS2_BITFIELD,
1506 bcm43xx_read32(bcm, BCM43xx_MMIO_STATUS2_BITFIELD) | (1 << 4));
1507 assert(bcm->noisecalc.core_at_start == bcm->current_core);
1508 assert(bcm->noisecalc.channel_at_start == bcm43xx_current_radio(bcm)->channel);
1511 static void bcm43xx_calculate_link_quality(struct bcm43xx_private *bcm)
1513 /* Top half of Link Quality calculation. */
1515 if (bcm->noisecalc.calculation_running)
1517 bcm->noisecalc.core_at_start = bcm->current_core;
1518 bcm->noisecalc.channel_at_start = bcm43xx_current_radio(bcm)->channel;
1519 bcm->noisecalc.calculation_running = 1;
1520 bcm->noisecalc.nr_samples = 0;
1522 bcm43xx_generate_noise_sample(bcm);
1525 static void handle_irq_noise(struct bcm43xx_private *bcm)
1527 struct bcm43xx_radioinfo *radio = bcm43xx_current_radio(bcm);
1533 /* Bottom half of Link Quality calculation. */
1535 assert(bcm->noisecalc.calculation_running);
1536 if (bcm->noisecalc.core_at_start != bcm->current_core ||
1537 bcm->noisecalc.channel_at_start != radio->channel)
1538 goto drop_calculation;
1539 tmp = bcm43xx_shm_read16(bcm, BCM43xx_SHM_SHARED, 0x408);
1540 noise[0] = (tmp & 0x00FF);
1541 noise[1] = (tmp & 0xFF00) >> 8;
1542 tmp = bcm43xx_shm_read16(bcm, BCM43xx_SHM_SHARED, 0x40A);
1543 noise[2] = (tmp & 0x00FF);
1544 noise[3] = (tmp & 0xFF00) >> 8;
1545 if (noise[0] == 0x7F || noise[1] == 0x7F ||
1546 noise[2] == 0x7F || noise[3] == 0x7F)
1549 /* Get the noise samples. */
1550 assert(bcm->noisecalc.nr_samples < 8);
1551 i = bcm->noisecalc.nr_samples;
1552 noise[0] = limit_value(noise[0], 0, ARRAY_SIZE(radio->nrssi_lt) - 1);
1553 noise[1] = limit_value(noise[1], 0, ARRAY_SIZE(radio->nrssi_lt) - 1);
1554 noise[2] = limit_value(noise[2], 0, ARRAY_SIZE(radio->nrssi_lt) - 1);
1555 noise[3] = limit_value(noise[3], 0, ARRAY_SIZE(radio->nrssi_lt) - 1);
1556 bcm->noisecalc.samples[i][0] = radio->nrssi_lt[noise[0]];
1557 bcm->noisecalc.samples[i][1] = radio->nrssi_lt[noise[1]];
1558 bcm->noisecalc.samples[i][2] = radio->nrssi_lt[noise[2]];
1559 bcm->noisecalc.samples[i][3] = radio->nrssi_lt[noise[3]];
1560 bcm->noisecalc.nr_samples++;
1561 if (bcm->noisecalc.nr_samples == 8) {
1562 /* Calculate the Link Quality by the noise samples. */
1564 for (i = 0; i < 8; i++) {
1565 for (j = 0; j < 4; j++)
1566 average += bcm->noisecalc.samples[i][j];
1573 tmp = bcm43xx_shm_read16(bcm, BCM43xx_SHM_SHARED, 0x40C);
1574 tmp = (tmp / 128) & 0x1F;
1584 /* FIXME: This is wrong, but people want fancy stats. well... */
1585 bcm->stats.noise = average;
1587 bcm->stats.link_quality = 0;
1588 else if (average > -75)
1589 bcm->stats.link_quality = 1;
1590 else if (average > -85)
1591 bcm->stats.link_quality = 2;
1593 bcm->stats.link_quality = 3;
1594 // dprintk(KERN_INFO PFX "Link Quality: %u (avg was %d)\n", bcm->stats.link_quality, average);
1596 bcm->noisecalc.calculation_running = 0;
1600 bcm43xx_generate_noise_sample(bcm);
1603 static void handle_irq_ps(struct bcm43xx_private *bcm)
1605 if (bcm->ieee->iw_mode == IW_MODE_MASTER) {
1608 if (1/*FIXME: the last PSpoll frame was sent successfully */)
1609 bcm43xx_power_saving_ctl_bits(bcm, -1, -1);
1611 if (bcm->ieee->iw_mode == IW_MODE_ADHOC)
1612 bcm->reg124_set_0x4 = 1;
1613 //FIXME else set to false?
1616 static void handle_irq_reg124(struct bcm43xx_private *bcm)
1618 if (!bcm->reg124_set_0x4)
1620 bcm43xx_write32(bcm, BCM43xx_MMIO_STATUS2_BITFIELD,
1621 bcm43xx_read32(bcm, BCM43xx_MMIO_STATUS2_BITFIELD)
1623 //FIXME: reset reg124_set_0x4 to false?
1626 static void handle_irq_pmq(struct bcm43xx_private *bcm)
1633 tmp = bcm43xx_read32(bcm, BCM43xx_MMIO_PS_STATUS);
1634 if (!(tmp & 0x00000008))
1637 /* 16bit write is odd, but correct. */
1638 bcm43xx_write16(bcm, BCM43xx_MMIO_PS_STATUS, 0x0002);
1641 static void bcm43xx_generate_beacon_template(struct bcm43xx_private *bcm,
1642 u16 ram_offset, u16 shm_size_offset)
1648 //FIXME: assumption: The chip sets the timestamp
1650 bcm43xx_ram_write(bcm, ram_offset++, value);
1651 bcm43xx_ram_write(bcm, ram_offset++, value);
1654 /* Beacon Interval / Capability Information */
1655 value = 0x0000;//FIXME: Which interval?
1656 value |= (1 << 0) << 16; /* ESS */
1657 value |= (1 << 2) << 16; /* CF Pollable */ //FIXME?
1658 value |= (1 << 3) << 16; /* CF Poll Request */ //FIXME?
1659 if (!bcm->ieee->open_wep)
1660 value |= (1 << 4) << 16; /* Privacy */
1661 bcm43xx_ram_write(bcm, ram_offset++, value);
1667 /* FH Parameter Set */
1670 /* DS Parameter Set */
1673 /* CF Parameter Set */
1679 bcm43xx_shm_write16(bcm, BCM43xx_SHM_SHARED, shm_size_offset, size);
1682 static void handle_irq_beacon(struct bcm43xx_private *bcm)
1686 bcm->irq_savedstate &= ~BCM43xx_IRQ_BEACON;
1687 status = bcm43xx_read32(bcm, BCM43xx_MMIO_STATUS2_BITFIELD);
1689 if ((status & 0x1) && (status & 0x2)) {
1690 /* ACK beacon IRQ. */
1691 bcm43xx_write32(bcm, BCM43xx_MMIO_GEN_IRQ_REASON,
1692 BCM43xx_IRQ_BEACON);
1693 bcm->irq_savedstate |= BCM43xx_IRQ_BEACON;
1696 if (!(status & 0x1)) {
1697 bcm43xx_generate_beacon_template(bcm, 0x68, 0x18);
1699 bcm43xx_write32(bcm, BCM43xx_MMIO_STATUS2_BITFIELD, status);
1701 if (!(status & 0x2)) {
1702 bcm43xx_generate_beacon_template(bcm, 0x468, 0x1A);
1704 bcm43xx_write32(bcm, BCM43xx_MMIO_STATUS2_BITFIELD, status);
1708 /* Interrupt handler bottom-half */
1709 static void bcm43xx_interrupt_tasklet(struct bcm43xx_private *bcm)
1714 unsigned long flags;
1716 #ifdef CONFIG_BCM43XX_DEBUG
1717 u32 _handled = 0x00000000;
1718 # define bcmirq_handled(irq) do { _handled |= (irq); } while (0)
1720 # define bcmirq_handled(irq) do { /* nothing */ } while (0)
1721 #endif /* CONFIG_BCM43XX_DEBUG*/
1723 spin_lock_irqsave(&bcm->irq_lock, flags);
1724 reason = bcm->irq_reason;
1725 dma_reason[0] = bcm->dma_reason[0];
1726 dma_reason[1] = bcm->dma_reason[1];
1727 dma_reason[2] = bcm->dma_reason[2];
1728 dma_reason[3] = bcm->dma_reason[3];
1730 if (unlikely(reason & BCM43xx_IRQ_XMIT_ERROR)) {
1731 /* TX error. We get this when Template Ram is written in wrong endianess
1732 * in dummy_tx(). We also get this if something is wrong with the TX header
1733 * on DMA or PIO queues.
1734 * Maybe we get this in other error conditions, too.
1736 printkl(KERN_ERR PFX "FATAL ERROR: BCM43xx_IRQ_XMIT_ERROR\n");
1737 bcmirq_handled(BCM43xx_IRQ_XMIT_ERROR);
1739 if (unlikely((dma_reason[0] & BCM43xx_DMAIRQ_FATALMASK) |
1740 (dma_reason[1] & BCM43xx_DMAIRQ_FATALMASK) |
1741 (dma_reason[2] & BCM43xx_DMAIRQ_FATALMASK) |
1742 (dma_reason[3] & BCM43xx_DMAIRQ_FATALMASK))) {
1743 printkl(KERN_ERR PFX "FATAL ERROR: Fatal DMA error: "
1744 "0x%08X, 0x%08X, 0x%08X, 0x%08X\n",
1745 dma_reason[0], dma_reason[1],
1746 dma_reason[2], dma_reason[3]);
1747 bcm43xx_controller_restart(bcm, "DMA error");
1749 spin_unlock_irqrestore(&bcm->irq_lock, flags);
1752 if (unlikely((dma_reason[0] & BCM43xx_DMAIRQ_NONFATALMASK) |
1753 (dma_reason[1] & BCM43xx_DMAIRQ_NONFATALMASK) |
1754 (dma_reason[2] & BCM43xx_DMAIRQ_NONFATALMASK) |
1755 (dma_reason[3] & BCM43xx_DMAIRQ_NONFATALMASK))) {
1756 printkl(KERN_ERR PFX "DMA error: "
1757 "0x%08X, 0x%08X, 0x%08X, 0x%08X\n",
1758 dma_reason[0], dma_reason[1],
1759 dma_reason[2], dma_reason[3]);
1762 if (reason & BCM43xx_IRQ_PS) {
1764 bcmirq_handled(BCM43xx_IRQ_PS);
1767 if (reason & BCM43xx_IRQ_REG124) {
1768 handle_irq_reg124(bcm);
1769 bcmirq_handled(BCM43xx_IRQ_REG124);
1772 if (reason & BCM43xx_IRQ_BEACON) {
1773 if (bcm->ieee->iw_mode == IW_MODE_MASTER)
1774 handle_irq_beacon(bcm);
1775 bcmirq_handled(BCM43xx_IRQ_BEACON);
1778 if (reason & BCM43xx_IRQ_PMQ) {
1779 handle_irq_pmq(bcm);
1780 bcmirq_handled(BCM43xx_IRQ_PMQ);
1783 if (reason & BCM43xx_IRQ_SCAN) {
1785 //bcmirq_handled(BCM43xx_IRQ_SCAN);
1788 if (reason & BCM43xx_IRQ_NOISE) {
1789 handle_irq_noise(bcm);
1790 bcmirq_handled(BCM43xx_IRQ_NOISE);
1793 /* Check the DMA reason registers for received data. */
1794 assert(!(dma_reason[1] & BCM43xx_DMAIRQ_RX_DONE));
1795 assert(!(dma_reason[2] & BCM43xx_DMAIRQ_RX_DONE));
1796 if (dma_reason[0] & BCM43xx_DMAIRQ_RX_DONE) {
1797 if (bcm43xx_using_pio(bcm))
1798 bcm43xx_pio_rx(bcm43xx_current_pio(bcm)->queue0);
1800 bcm43xx_dma_rx(bcm43xx_current_dma(bcm)->rx_ring0);
1801 /* We intentionally don't set "activity" to 1, here. */
1803 if (dma_reason[3] & BCM43xx_DMAIRQ_RX_DONE) {
1804 if (bcm43xx_using_pio(bcm))
1805 bcm43xx_pio_rx(bcm43xx_current_pio(bcm)->queue3);
1807 bcm43xx_dma_rx(bcm43xx_current_dma(bcm)->rx_ring1);
1810 bcmirq_handled(BCM43xx_IRQ_RX);
1812 if (reason & BCM43xx_IRQ_XMIT_STATUS) {
1813 handle_irq_transmit_status(bcm);
1815 //TODO: In AP mode, this also causes sending of powersave responses.
1816 bcmirq_handled(BCM43xx_IRQ_XMIT_STATUS);
1819 /* IRQ_PIO_WORKAROUND is handled in the top-half. */
1820 bcmirq_handled(BCM43xx_IRQ_PIO_WORKAROUND);
1821 #ifdef CONFIG_BCM43XX_DEBUG
1822 if (unlikely(reason & ~_handled)) {
1823 printkl(KERN_WARNING PFX
1824 "Unhandled IRQ! Reason: 0x%08x, Unhandled: 0x%08x, "
1825 "DMA: 0x%08x, 0x%08x, 0x%08x, 0x%08x\n",
1826 reason, (reason & ~_handled),
1827 dma_reason[0], dma_reason[1],
1828 dma_reason[2], dma_reason[3]);
1831 #undef bcmirq_handled
1833 if (!modparam_noleds)
1834 bcm43xx_leds_update(bcm, activity);
1835 bcm43xx_interrupt_enable(bcm, bcm->irq_savedstate);
1837 spin_unlock_irqrestore(&bcm->irq_lock, flags);
1840 static void pio_irq_workaround(struct bcm43xx_private *bcm,
1841 u16 base, int queueidx)
1845 rxctl = bcm43xx_read16(bcm, base + BCM43xx_PIO_RXCTL);
1846 if (rxctl & BCM43xx_PIO_RXCTL_DATAAVAILABLE)
1847 bcm->dma_reason[queueidx] |= BCM43xx_DMAIRQ_RX_DONE;
1849 bcm->dma_reason[queueidx] &= ~BCM43xx_DMAIRQ_RX_DONE;
1852 static void bcm43xx_interrupt_ack(struct bcm43xx_private *bcm, u32 reason)
1854 if (bcm43xx_using_pio(bcm) &&
1855 (bcm->current_core->rev < 3) &&
1856 (!(reason & BCM43xx_IRQ_PIO_WORKAROUND))) {
1857 /* Apply a PIO specific workaround to the dma_reasons */
1858 pio_irq_workaround(bcm, BCM43xx_MMIO_PIO1_BASE, 0);
1859 pio_irq_workaround(bcm, BCM43xx_MMIO_PIO2_BASE, 1);
1860 pio_irq_workaround(bcm, BCM43xx_MMIO_PIO3_BASE, 2);
1861 pio_irq_workaround(bcm, BCM43xx_MMIO_PIO4_BASE, 3);
1864 bcm43xx_write32(bcm, BCM43xx_MMIO_GEN_IRQ_REASON, reason);
1866 bcm43xx_write32(bcm, BCM43xx_MMIO_DMA1_REASON,
1867 bcm->dma_reason[0]);
1868 bcm43xx_write32(bcm, BCM43xx_MMIO_DMA2_REASON,
1869 bcm->dma_reason[1]);
1870 bcm43xx_write32(bcm, BCM43xx_MMIO_DMA3_REASON,
1871 bcm->dma_reason[2]);
1872 bcm43xx_write32(bcm, BCM43xx_MMIO_DMA4_REASON,
1873 bcm->dma_reason[3]);
1876 /* Interrupt handler top-half */
1877 static irqreturn_t bcm43xx_interrupt_handler(int irq, void *dev_id, struct pt_regs *regs)
1879 irqreturn_t ret = IRQ_HANDLED;
1880 struct bcm43xx_private *bcm = dev_id;
1886 spin_lock(&bcm->irq_lock);
1888 /* Only accept IRQs, if we are initialized properly.
1889 * This avoids an RX race while initializing.
1890 * We should probably not enable IRQs before we are initialized
1891 * completely, but some careful work is needed to fix this. I think it
1892 * is best to stay with this cheap workaround for now... .
1894 if (unlikely(bcm43xx_status(bcm) != BCM43xx_STAT_INITIALIZED))
1897 reason = bcm43xx_read32(bcm, BCM43xx_MMIO_GEN_IRQ_REASON);
1898 if (reason == 0xffffffff) {
1899 /* irq not for us (shared irq) */
1903 reason &= bcm43xx_read32(bcm, BCM43xx_MMIO_GEN_IRQ_MASK);
1907 bcm->dma_reason[0] = bcm43xx_read32(bcm, BCM43xx_MMIO_DMA1_REASON)
1909 bcm->dma_reason[1] = bcm43xx_read32(bcm, BCM43xx_MMIO_DMA2_REASON)
1911 bcm->dma_reason[2] = bcm43xx_read32(bcm, BCM43xx_MMIO_DMA3_REASON)
1913 bcm->dma_reason[3] = bcm43xx_read32(bcm, BCM43xx_MMIO_DMA4_REASON)
1916 bcm43xx_interrupt_ack(bcm, reason);
1918 /* disable all IRQs. They are enabled again in the bottom half. */
1919 bcm->irq_savedstate = bcm43xx_interrupt_disable(bcm, BCM43xx_IRQ_ALL);
1920 /* save the reason code and call our bottom half. */
1921 bcm->irq_reason = reason;
1922 tasklet_schedule(&bcm->isr_tasklet);
1926 spin_unlock(&bcm->irq_lock);
1931 static void bcm43xx_release_firmware(struct bcm43xx_private *bcm, int force)
1933 if (bcm->firmware_norelease && !force)
1934 return; /* Suspending or controller reset. */
1935 release_firmware(bcm->ucode);
1937 release_firmware(bcm->pcm);
1939 release_firmware(bcm->initvals0);
1940 bcm->initvals0 = NULL;
1941 release_firmware(bcm->initvals1);
1942 bcm->initvals1 = NULL;
1945 static int bcm43xx_request_firmware(struct bcm43xx_private *bcm)
1947 struct bcm43xx_phyinfo *phy = bcm43xx_current_phy(bcm);
1948 u8 rev = bcm->current_core->rev;
1951 char buf[22 + sizeof(modparam_fwpostfix) - 1] = { 0 };
1954 snprintf(buf, ARRAY_SIZE(buf), "bcm43xx_microcode%d%s.fw",
1955 (rev >= 5 ? 5 : rev),
1956 modparam_fwpostfix);
1957 err = request_firmware(&bcm->ucode, buf, &bcm->pci_dev->dev);
1960 "Error: Microcode \"%s\" not available or load failed.\n",
1967 snprintf(buf, ARRAY_SIZE(buf),
1968 "bcm43xx_pcm%d%s.fw",
1970 modparam_fwpostfix);
1971 err = request_firmware(&bcm->pcm, buf, &bcm->pci_dev->dev);
1974 "Error: PCM \"%s\" not available or load failed.\n",
1980 if (!bcm->initvals0) {
1981 if (rev == 2 || rev == 4) {
1982 switch (phy->type) {
1983 case BCM43xx_PHYTYPE_A:
1986 case BCM43xx_PHYTYPE_B:
1987 case BCM43xx_PHYTYPE_G:
1994 } else if (rev >= 5) {
1995 switch (phy->type) {
1996 case BCM43xx_PHYTYPE_A:
1999 case BCM43xx_PHYTYPE_B:
2000 case BCM43xx_PHYTYPE_G:
2008 snprintf(buf, ARRAY_SIZE(buf), "bcm43xx_initval%02d%s.fw",
2009 nr, modparam_fwpostfix);
2011 err = request_firmware(&bcm->initvals0, buf, &bcm->pci_dev->dev);
2014 "Error: InitVals \"%s\" not available or load failed.\n",
2018 if (bcm->initvals0->size % sizeof(struct bcm43xx_initval)) {
2019 printk(KERN_ERR PFX "InitVals fileformat error.\n");
2024 if (!bcm->initvals1) {
2028 switch (phy->type) {
2029 case BCM43xx_PHYTYPE_A:
2030 sbtmstatehigh = bcm43xx_read32(bcm, BCM43xx_CIR_SBTMSTATEHIGH);
2031 if (sbtmstatehigh & 0x00010000)
2036 case BCM43xx_PHYTYPE_B:
2037 case BCM43xx_PHYTYPE_G:
2043 snprintf(buf, ARRAY_SIZE(buf), "bcm43xx_initval%02d%s.fw",
2044 nr, modparam_fwpostfix);
2046 err = request_firmware(&bcm->initvals1, buf, &bcm->pci_dev->dev);
2049 "Error: InitVals \"%s\" not available or load failed.\n",
2053 if (bcm->initvals1->size % sizeof(struct bcm43xx_initval)) {
2054 printk(KERN_ERR PFX "InitVals fileformat error.\n");
2063 bcm43xx_release_firmware(bcm, 1);
2066 printk(KERN_ERR PFX "Error: No InitVals available!\n");
2071 static void bcm43xx_upload_microcode(struct bcm43xx_private *bcm)
2074 unsigned int i, len;
2076 /* Upload Microcode. */
2077 data = (u32 *)(bcm->ucode->data);
2078 len = bcm->ucode->size / sizeof(u32);
2079 bcm43xx_shm_control_word(bcm, BCM43xx_SHM_UCODE, 0x0000);
2080 for (i = 0; i < len; i++) {
2081 bcm43xx_write32(bcm, BCM43xx_MMIO_SHM_DATA,
2082 be32_to_cpu(data[i]));
2086 /* Upload PCM data. */
2087 data = (u32 *)(bcm->pcm->data);
2088 len = bcm->pcm->size / sizeof(u32);
2089 bcm43xx_shm_control_word(bcm, BCM43xx_SHM_PCM, 0x01ea);
2090 bcm43xx_write32(bcm, BCM43xx_MMIO_SHM_DATA, 0x00004000);
2091 bcm43xx_shm_control_word(bcm, BCM43xx_SHM_PCM, 0x01eb);
2092 for (i = 0; i < len; i++) {
2093 bcm43xx_write32(bcm, BCM43xx_MMIO_SHM_DATA,
2094 be32_to_cpu(data[i]));
2099 static int bcm43xx_write_initvals(struct bcm43xx_private *bcm,
2100 const struct bcm43xx_initval *data,
2101 const unsigned int len)
2107 for (i = 0; i < len; i++) {
2108 offset = be16_to_cpu(data[i].offset);
2109 size = be16_to_cpu(data[i].size);
2110 value = be32_to_cpu(data[i].value);
2112 if (unlikely(offset >= 0x1000))
2115 if (unlikely(value & 0xFFFF0000))
2117 bcm43xx_write16(bcm, offset, (u16)value);
2118 } else if (size == 4) {
2119 bcm43xx_write32(bcm, offset, value);
2127 printk(KERN_ERR PFX "InitVals (bcm43xx_initvalXX.fw) file-format error. "
2128 "Please fix your bcm43xx firmware files.\n");
2132 static int bcm43xx_upload_initvals(struct bcm43xx_private *bcm)
2136 err = bcm43xx_write_initvals(bcm, (struct bcm43xx_initval *)bcm->initvals0->data,
2137 bcm->initvals0->size / sizeof(struct bcm43xx_initval));
2140 if (bcm->initvals1) {
2141 err = bcm43xx_write_initvals(bcm, (struct bcm43xx_initval *)bcm->initvals1->data,
2142 bcm->initvals1->size / sizeof(struct bcm43xx_initval));
2150 #ifdef CONFIG_BCM947XX
2151 static struct pci_device_id bcm43xx_47xx_ids[] = {
2152 { PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 0x4324) },
2157 static int bcm43xx_initialize_irq(struct bcm43xx_private *bcm)
2163 bcm->irq = bcm->pci_dev->irq;
2164 #ifdef CONFIG_BCM947XX
2165 if (bcm->pci_dev->bus->number == 0) {
2167 struct pci_device_id *id;
2168 for (id = bcm43xx_47xx_ids; id->vendor; id++) {
2169 d = pci_get_device(id->vendor, id->device, NULL);
2178 res = request_irq(bcm->irq, bcm43xx_interrupt_handler,
2179 IRQF_SHARED, KBUILD_MODNAME, bcm);
2181 printk(KERN_ERR PFX "Cannot register IRQ%d\n", bcm->irq);
2184 bcm43xx_write32(bcm, BCM43xx_MMIO_GEN_IRQ_REASON, 0xffffffff);
2185 bcm43xx_write32(bcm, BCM43xx_MMIO_STATUS_BITFIELD, 0x00020402);
2188 data = bcm43xx_read32(bcm, BCM43xx_MMIO_GEN_IRQ_REASON);
2189 if (data == BCM43xx_IRQ_READY)
2192 if (i >= BCM43xx_IRQWAIT_MAX_RETRIES) {
2193 printk(KERN_ERR PFX "Card IRQ register not responding. "
2195 free_irq(bcm->irq, bcm);
2201 bcm43xx_read32(bcm, BCM43xx_MMIO_GEN_IRQ_REASON);
2206 /* Switch to the core used to write the GPIO register.
2207 * This is either the ChipCommon, or the PCI core.
2209 static int switch_to_gpio_core(struct bcm43xx_private *bcm)
2213 /* Where to find the GPIO register depends on the chipset.
2214 * If it has a ChipCommon, its register at offset 0x6c is the GPIO
2215 * control register. Otherwise the register at offset 0x6c in the
2216 * PCI core is the GPIO control register.
2218 err = bcm43xx_switch_core(bcm, &bcm->core_chipcommon);
2219 if (err == -ENODEV) {
2220 err = bcm43xx_switch_core(bcm, &bcm->core_pci);
2221 if (unlikely(err == -ENODEV)) {
2222 printk(KERN_ERR PFX "gpio error: "
2223 "Neither ChipCommon nor PCI core available!\n");
2230 /* Initialize the GPIOs
2231 * http://bcm-specs.sipsolutions.net/GPIO
2233 static int bcm43xx_gpio_init(struct bcm43xx_private *bcm)
2235 struct bcm43xx_coreinfo *old_core;
2239 bcm43xx_write32(bcm, BCM43xx_MMIO_STATUS_BITFIELD,
2240 bcm43xx_read32(bcm, BCM43xx_MMIO_STATUS_BITFIELD)
2243 bcm43xx_leds_switch_all(bcm, 0);
2244 bcm43xx_write16(bcm, BCM43xx_MMIO_GPIO_MASK,
2245 bcm43xx_read16(bcm, BCM43xx_MMIO_GPIO_MASK) | 0x000F);
2249 if (bcm->chip_id == 0x4301) {
2253 if (0 /* FIXME: conditional unknown */) {
2254 bcm43xx_write16(bcm, BCM43xx_MMIO_GPIO_MASK,
2255 bcm43xx_read16(bcm, BCM43xx_MMIO_GPIO_MASK)
2260 if (bcm->sprom.boardflags & BCM43xx_BFL_PACTRL) {
2261 bcm43xx_write16(bcm, BCM43xx_MMIO_GPIO_MASK,
2262 bcm43xx_read16(bcm, BCM43xx_MMIO_GPIO_MASK)
2267 if (bcm->current_core->rev >= 2)
2268 mask |= 0x0010; /* FIXME: This is redundant. */
2270 old_core = bcm->current_core;
2271 err = switch_to_gpio_core(bcm);
2274 bcm43xx_write32(bcm, BCM43xx_GPIO_CONTROL,
2275 (bcm43xx_read32(bcm, BCM43xx_GPIO_CONTROL) & mask) | set);
2276 err = bcm43xx_switch_core(bcm, old_core);
2281 /* Turn off all GPIO stuff. Call this on module unload, for example. */
2282 static int bcm43xx_gpio_cleanup(struct bcm43xx_private *bcm)
2284 struct bcm43xx_coreinfo *old_core;
2287 old_core = bcm->current_core;
2288 err = switch_to_gpio_core(bcm);
2291 bcm43xx_write32(bcm, BCM43xx_GPIO_CONTROL, 0x00000000);
2292 err = bcm43xx_switch_core(bcm, old_core);
2298 /* http://bcm-specs.sipsolutions.net/EnableMac */
2299 void bcm43xx_mac_enable(struct bcm43xx_private *bcm)
2301 bcm->mac_suspended--;
2302 assert(bcm->mac_suspended >= 0);
2303 if (bcm->mac_suspended == 0) {
2304 bcm43xx_write32(bcm, BCM43xx_MMIO_STATUS_BITFIELD,
2305 bcm43xx_read32(bcm, BCM43xx_MMIO_STATUS_BITFIELD)
2306 | BCM43xx_SBF_MAC_ENABLED);
2307 bcm43xx_write32(bcm, BCM43xx_MMIO_GEN_IRQ_REASON, BCM43xx_IRQ_READY);
2308 bcm43xx_read32(bcm, BCM43xx_MMIO_STATUS_BITFIELD); /* dummy read */
2309 bcm43xx_read32(bcm, BCM43xx_MMIO_GEN_IRQ_REASON); /* dummy read */
2310 bcm43xx_power_saving_ctl_bits(bcm, -1, -1);
2314 /* http://bcm-specs.sipsolutions.net/SuspendMAC */
2315 void bcm43xx_mac_suspend(struct bcm43xx_private *bcm)
2320 assert(bcm->mac_suspended >= 0);
2321 if (bcm->mac_suspended == 0) {
2322 bcm43xx_power_saving_ctl_bits(bcm, -1, 1);
2323 bcm43xx_write32(bcm, BCM43xx_MMIO_STATUS_BITFIELD,
2324 bcm43xx_read32(bcm, BCM43xx_MMIO_STATUS_BITFIELD)
2325 & ~BCM43xx_SBF_MAC_ENABLED);
2326 bcm43xx_read32(bcm, BCM43xx_MMIO_GEN_IRQ_REASON); /* dummy read */
2327 for (i = 100000; i; i--) {
2328 tmp = bcm43xx_read32(bcm, BCM43xx_MMIO_GEN_IRQ_REASON);
2329 if (tmp & BCM43xx_IRQ_READY)
2333 printkl(KERN_ERR PFX "MAC suspend failed\n");
2336 bcm->mac_suspended++;
2339 void bcm43xx_set_iwmode(struct bcm43xx_private *bcm,
2342 unsigned long flags;
2343 struct net_device *net_dev = bcm->net_dev;
2347 spin_lock_irqsave(&bcm->ieee->lock, flags);
2348 bcm->ieee->iw_mode = iw_mode;
2349 spin_unlock_irqrestore(&bcm->ieee->lock, flags);
2350 if (iw_mode == IW_MODE_MONITOR)
2351 net_dev->type = ARPHRD_IEEE80211;
2353 net_dev->type = ARPHRD_ETHER;
2355 status = bcm43xx_read32(bcm, BCM43xx_MMIO_STATUS_BITFIELD);
2356 /* Reset status to infrastructured mode */
2357 status &= ~(BCM43xx_SBF_MODE_AP | BCM43xx_SBF_MODE_MONITOR);
2358 status &= ~BCM43xx_SBF_MODE_PROMISC;
2359 status |= BCM43xx_SBF_MODE_NOTADHOC;
2361 /* FIXME: Always enable promisc mode, until we get the MAC filters working correctly. */
2362 status |= BCM43xx_SBF_MODE_PROMISC;
2365 case IW_MODE_MONITOR:
2366 status |= BCM43xx_SBF_MODE_MONITOR;
2367 status |= BCM43xx_SBF_MODE_PROMISC;
2370 status &= ~BCM43xx_SBF_MODE_NOTADHOC;
2372 case IW_MODE_MASTER:
2373 status |= BCM43xx_SBF_MODE_AP;
2375 case IW_MODE_SECOND:
2376 case IW_MODE_REPEAT:
2380 /* nothing to be done here... */
2383 dprintk(KERN_ERR PFX "Unknown mode in set_iwmode: %d\n", iw_mode);
2385 if (net_dev->flags & IFF_PROMISC)
2386 status |= BCM43xx_SBF_MODE_PROMISC;
2387 bcm43xx_write32(bcm, BCM43xx_MMIO_STATUS_BITFIELD, status);
2390 if (iw_mode != IW_MODE_ADHOC && iw_mode != IW_MODE_MASTER) {
2391 if (bcm->chip_id == 0x4306 && bcm->chip_rev == 3)
2396 bcm43xx_write16(bcm, 0x0612, value);
2399 /* This is the opposite of bcm43xx_chip_init() */
2400 static void bcm43xx_chip_cleanup(struct bcm43xx_private *bcm)
2402 bcm43xx_radio_turn_off(bcm);
2403 if (!modparam_noleds)
2404 bcm43xx_leds_exit(bcm);
2405 bcm43xx_gpio_cleanup(bcm);
2406 free_irq(bcm->irq, bcm);
2407 bcm43xx_release_firmware(bcm, 0);
2410 /* Initialize the chip
2411 * http://bcm-specs.sipsolutions.net/ChipInit
2413 static int bcm43xx_chip_init(struct bcm43xx_private *bcm)
2415 struct bcm43xx_radioinfo *radio = bcm43xx_current_radio(bcm);
2416 struct bcm43xx_phyinfo *phy = bcm43xx_current_phy(bcm);
2422 bcm43xx_write32(bcm, BCM43xx_MMIO_STATUS_BITFIELD,
2423 BCM43xx_SBF_CORE_READY
2426 err = bcm43xx_request_firmware(bcm);
2429 bcm43xx_upload_microcode(bcm);
2431 err = bcm43xx_initialize_irq(bcm);
2433 goto err_release_fw;
2435 err = bcm43xx_gpio_init(bcm);
2439 err = bcm43xx_upload_initvals(bcm);
2441 goto err_gpio_cleanup;
2442 bcm43xx_radio_turn_on(bcm);
2444 bcm43xx_write16(bcm, 0x03E6, 0x0000);
2445 err = bcm43xx_phy_init(bcm);
2449 /* Select initial Interference Mitigation. */
2450 tmp = radio->interfmode;
2451 radio->interfmode = BCM43xx_RADIO_INTERFMODE_NONE;
2452 bcm43xx_radio_set_interference_mitigation(bcm, tmp);
2454 bcm43xx_phy_set_antenna_diversity(bcm);
2455 bcm43xx_radio_set_txantenna(bcm, BCM43xx_RADIO_TXANTENNA_DEFAULT);
2456 if (phy->type == BCM43xx_PHYTYPE_B) {
2457 value16 = bcm43xx_read16(bcm, 0x005E);
2459 bcm43xx_write16(bcm, 0x005E, value16);
2461 bcm43xx_write32(bcm, 0x0100, 0x01000000);
2462 if (bcm->current_core->rev < 5)
2463 bcm43xx_write32(bcm, 0x010C, 0x01000000);
2465 value32 = bcm43xx_read32(bcm, BCM43xx_MMIO_STATUS_BITFIELD);
2466 value32 &= ~ BCM43xx_SBF_MODE_NOTADHOC;
2467 bcm43xx_write32(bcm, BCM43xx_MMIO_STATUS_BITFIELD, value32);
2468 value32 = bcm43xx_read32(bcm, BCM43xx_MMIO_STATUS_BITFIELD);
2469 value32 |= BCM43xx_SBF_MODE_NOTADHOC;
2470 bcm43xx_write32(bcm, BCM43xx_MMIO_STATUS_BITFIELD, value32);
2472 value32 = bcm43xx_read32(bcm, BCM43xx_MMIO_STATUS_BITFIELD);
2473 value32 |= 0x100000;
2474 bcm43xx_write32(bcm, BCM43xx_MMIO_STATUS_BITFIELD, value32);
2476 if (bcm43xx_using_pio(bcm)) {
2477 bcm43xx_write32(bcm, 0x0210, 0x00000100);
2478 bcm43xx_write32(bcm, 0x0230, 0x00000100);
2479 bcm43xx_write32(bcm, 0x0250, 0x00000100);
2480 bcm43xx_write32(bcm, 0x0270, 0x00000100);
2481 bcm43xx_shm_write16(bcm, BCM43xx_SHM_SHARED, 0x0034, 0x0000);
2484 /* Probe Response Timeout value */
2485 /* FIXME: Default to 0, has to be set by ioctl probably... :-/ */
2486 bcm43xx_shm_write16(bcm, BCM43xx_SHM_SHARED, 0x0074, 0x0000);
2488 /* Initially set the wireless operation mode. */
2489 bcm43xx_set_iwmode(bcm, bcm->ieee->iw_mode);
2491 if (bcm->current_core->rev < 3) {
2492 bcm43xx_write16(bcm, 0x060E, 0x0000);
2493 bcm43xx_write16(bcm, 0x0610, 0x8000);
2494 bcm43xx_write16(bcm, 0x0604, 0x0000);
2495 bcm43xx_write16(bcm, 0x0606, 0x0200);
2497 bcm43xx_write32(bcm, 0x0188, 0x80000000);
2498 bcm43xx_write32(bcm, 0x018C, 0x02000000);
2500 bcm43xx_write32(bcm, BCM43xx_MMIO_GEN_IRQ_REASON, 0x00004000);
2501 bcm43xx_write32(bcm, BCM43xx_MMIO_DMA1_IRQ_MASK, 0x0001DC00);
2502 bcm43xx_write32(bcm, BCM43xx_MMIO_DMA2_IRQ_MASK, 0x0000DC00);
2503 bcm43xx_write32(bcm, BCM43xx_MMIO_DMA3_IRQ_MASK, 0x0000DC00);
2504 bcm43xx_write32(bcm, BCM43xx_MMIO_DMA4_IRQ_MASK, 0x0001DC00);
2506 value32 = bcm43xx_read32(bcm, BCM43xx_CIR_SBTMSTATELOW);
2507 value32 |= 0x00100000;
2508 bcm43xx_write32(bcm, BCM43xx_CIR_SBTMSTATELOW, value32);
2510 bcm43xx_write16(bcm, BCM43xx_MMIO_POWERUP_DELAY, bcm43xx_pctl_powerup_delay(bcm));
2513 dprintk(KERN_INFO PFX "Chip initialized\n");
2518 bcm43xx_radio_turn_off(bcm);
2520 bcm43xx_gpio_cleanup(bcm);
2522 free_irq(bcm->irq, bcm);
2524 bcm43xx_release_firmware(bcm, 1);
2528 /* Validate chip access
2529 * http://bcm-specs.sipsolutions.net/ValidateChipAccess */
2530 static int bcm43xx_validate_chip(struct bcm43xx_private *bcm)
2535 shm_backup = bcm43xx_shm_read32(bcm, BCM43xx_SHM_SHARED, 0x0000);
2536 bcm43xx_shm_write32(bcm, BCM43xx_SHM_SHARED, 0x0000, 0xAA5555AA);
2537 if (bcm43xx_shm_read32(bcm, BCM43xx_SHM_SHARED, 0x0000) != 0xAA5555AA)
2539 bcm43xx_shm_write32(bcm, BCM43xx_SHM_SHARED, 0x0000, 0x55AAAA55);
2540 if (bcm43xx_shm_read32(bcm, BCM43xx_SHM_SHARED, 0x0000) != 0x55AAAA55)
2542 bcm43xx_shm_write32(bcm, BCM43xx_SHM_SHARED, 0x0000, shm_backup);
2544 value = bcm43xx_read32(bcm, BCM43xx_MMIO_STATUS_BITFIELD);
2545 if ((value | 0x80000000) != 0x80000400)
2548 value = bcm43xx_read32(bcm, BCM43xx_MMIO_GEN_IRQ_REASON);
2549 if (value != 0x00000000)
2554 printk(KERN_ERR PFX "Failed to validate the chipaccess\n");
2558 static void bcm43xx_init_struct_phyinfo(struct bcm43xx_phyinfo *phy)
2560 /* Initialize a "phyinfo" structure. The structure is already
2563 phy->antenna_diversity = 0xFFFF;
2564 phy->savedpctlreg = 0xFFFF;
2565 phy->minlowsig[0] = 0xFFFF;
2566 phy->minlowsig[1] = 0xFFFF;
2567 spin_lock_init(&phy->lock);
2570 static void bcm43xx_init_struct_radioinfo(struct bcm43xx_radioinfo *radio)
2572 /* Initialize a "radioinfo" structure. The structure is already
2575 radio->interfmode = BCM43xx_RADIO_INTERFMODE_NONE;
2576 radio->channel = 0xFF;
2577 radio->initial_channel = 0xFF;
2578 radio->lofcal = 0xFFFF;
2579 radio->initval = 0xFFFF;
2580 radio->nrssi[0] = -1000;
2581 radio->nrssi[1] = -1000;
2584 static int bcm43xx_probe_cores(struct bcm43xx_private *bcm)
2588 u32 core_vendor, core_id, core_rev;
2589 u32 sb_id_hi, chip_id_32 = 0;
2590 u16 pci_device, chip_id_16;
2593 memset(&bcm->core_chipcommon, 0, sizeof(struct bcm43xx_coreinfo));
2594 memset(&bcm->core_pci, 0, sizeof(struct bcm43xx_coreinfo));
2595 memset(&bcm->core_80211, 0, sizeof(struct bcm43xx_coreinfo)
2596 * BCM43xx_MAX_80211_CORES);
2597 memset(&bcm->core_80211_ext, 0, sizeof(struct bcm43xx_coreinfo_80211)
2598 * BCM43xx_MAX_80211_CORES);
2599 bcm->current_80211_core_idx = -1;
2600 bcm->nr_80211_available = 0;
2601 bcm->current_core = NULL;
2602 bcm->active_80211_core = NULL;
2605 err = _switch_core(bcm, 0);
2609 /* fetch sb_id_hi from core information registers */
2610 sb_id_hi = bcm43xx_read32(bcm, BCM43xx_CIR_SB_ID_HI);
2612 core_id = (sb_id_hi & 0xFFF0) >> 4;
2613 core_rev = (sb_id_hi & 0xF);
2614 core_vendor = (sb_id_hi & 0xFFFF0000) >> 16;
2616 /* if present, chipcommon is always core 0; read the chipid from it */
2617 if (core_id == BCM43xx_COREID_CHIPCOMMON) {
2618 chip_id_32 = bcm43xx_read32(bcm, 0);
2619 chip_id_16 = chip_id_32 & 0xFFFF;
2620 bcm->core_chipcommon.available = 1;
2621 bcm->core_chipcommon.id = core_id;
2622 bcm->core_chipcommon.rev = core_rev;
2623 bcm->core_chipcommon.index = 0;
2624 /* While we are at it, also read the capabilities. */
2625 bcm->chipcommon_capabilities = bcm43xx_read32(bcm, BCM43xx_CHIPCOMMON_CAPABILITIES);
2627 /* without a chipCommon, use a hard coded table. */
2628 pci_device = bcm->pci_dev->device;
2629 if (pci_device == 0x4301)
2630 chip_id_16 = 0x4301;
2631 else if ((pci_device >= 0x4305) && (pci_device <= 0x4307))
2632 chip_id_16 = 0x4307;
2633 else if ((pci_device >= 0x4402) && (pci_device <= 0x4403))
2634 chip_id_16 = 0x4402;
2635 else if ((pci_device >= 0x4610) && (pci_device <= 0x4615))
2636 chip_id_16 = 0x4610;
2637 else if ((pci_device >= 0x4710) && (pci_device <= 0x4715))
2638 chip_id_16 = 0x4710;
2639 #ifdef CONFIG_BCM947XX
2640 else if ((pci_device >= 0x4320) && (pci_device <= 0x4325))
2641 chip_id_16 = 0x4309;
2644 printk(KERN_ERR PFX "Could not determine Chip ID\n");
2649 /* ChipCommon with Core Rev >=4 encodes number of cores,
2650 * otherwise consult hardcoded table */
2651 if ((core_id == BCM43xx_COREID_CHIPCOMMON) && (core_rev >= 4)) {
2652 core_count = (chip_id_32 & 0x0F000000) >> 24;
2654 switch (chip_id_16) {
2677 /* SOL if we get here */
2683 bcm->chip_id = chip_id_16;
2684 bcm->chip_rev = (chip_id_32 & 0x000F0000) >> 16;
2685 bcm->chip_package = (chip_id_32 & 0x00F00000) >> 20;
2687 dprintk(KERN_INFO PFX "Chip ID 0x%x, rev 0x%x\n",
2688 bcm->chip_id, bcm->chip_rev);
2689 dprintk(KERN_INFO PFX "Number of cores: %d\n", core_count);
2690 if (bcm->core_chipcommon.available) {
2691 dprintk(KERN_INFO PFX "Core 0: ID 0x%x, rev 0x%x, vendor 0x%x, %s\n",
2692 core_id, core_rev, core_vendor,
2693 bcm43xx_core_enabled(bcm) ? "enabled" : "disabled");
2696 if (bcm->core_chipcommon.available)
2700 for ( ; current_core < core_count; current_core++) {
2701 struct bcm43xx_coreinfo *core;
2702 struct bcm43xx_coreinfo_80211 *ext_80211;
2704 err = _switch_core(bcm, current_core);
2707 /* Gather information */
2708 /* fetch sb_id_hi from core information registers */
2709 sb_id_hi = bcm43xx_read32(bcm, BCM43xx_CIR_SB_ID_HI);
2711 /* extract core_id, core_rev, core_vendor */
2712 core_id = (sb_id_hi & 0xFFF0) >> 4;
2713 core_rev = (sb_id_hi & 0xF);
2714 core_vendor = (sb_id_hi & 0xFFFF0000) >> 16;
2716 dprintk(KERN_INFO PFX "Core %d: ID 0x%x, rev 0x%x, vendor 0x%x, %s\n",
2717 current_core, core_id, core_rev, core_vendor,
2718 bcm43xx_core_enabled(bcm) ? "enabled" : "disabled" );
2722 case BCM43xx_COREID_PCI:
2723 core = &bcm->core_pci;
2724 if (core->available) {
2725 printk(KERN_WARNING PFX "Multiple PCI cores found.\n");
2729 case BCM43xx_COREID_80211:
2730 for (i = 0; i < BCM43xx_MAX_80211_CORES; i++) {
2731 core = &(bcm->core_80211[i]);
2732 ext_80211 = &(bcm->core_80211_ext[i]);
2733 if (!core->available)
2738 printk(KERN_WARNING PFX "More than %d cores of type 802.11 found.\n",
2739 BCM43xx_MAX_80211_CORES);
2743 /* More than one 80211 core is only supported
2745 * There are chips with two 80211 cores, but with
2746 * dangling pins on the second core. Be careful
2747 * and ignore these cores here.
2749 if (bcm->pci_dev->device != 0x4324) {
2750 dprintk(KERN_INFO PFX "Ignoring additional 802.11 core.\n");
2763 printk(KERN_ERR PFX "Error: Unsupported 80211 core revision %u\n",
2768 bcm->nr_80211_available++;
2769 bcm43xx_init_struct_phyinfo(&ext_80211->phy);
2770 bcm43xx_init_struct_radioinfo(&ext_80211->radio);
2772 case BCM43xx_COREID_CHIPCOMMON:
2773 printk(KERN_WARNING PFX "Multiple CHIPCOMMON cores found.\n");
2777 core->available = 1;
2779 core->rev = core_rev;
2780 core->index = current_core;
2784 if (!bcm->core_80211[0].available) {
2785 printk(KERN_ERR PFX "Error: No 80211 core found!\n");
2790 err = bcm43xx_switch_core(bcm, &bcm->core_80211[0]);
2797 static void bcm43xx_gen_bssid(struct bcm43xx_private *bcm)
2799 const u8 *mac = (const u8*)(bcm->net_dev->dev_addr);
2800 u8 *bssid = bcm->ieee->bssid;
2802 switch (bcm->ieee->iw_mode) {
2804 random_ether_addr(bssid);
2806 case IW_MODE_MASTER:
2808 case IW_MODE_REPEAT:
2809 case IW_MODE_SECOND:
2810 case IW_MODE_MONITOR:
2811 memcpy(bssid, mac, ETH_ALEN);
2818 static void bcm43xx_rate_memory_write(struct bcm43xx_private *bcm,
2826 offset += (bcm43xx_plcp_get_ratecode_ofdm(rate) & 0x000F) * 2;
2830 offset += (bcm43xx_plcp_get_ratecode_cck(rate) & 0x000F) * 2;
2832 bcm43xx_shm_write16(bcm, BCM43xx_SHM_SHARED, offset + 0x20,
2833 bcm43xx_shm_read16(bcm, BCM43xx_SHM_SHARED, offset));
2836 static void bcm43xx_rate_memory_init(struct bcm43xx_private *bcm)
2838 switch (bcm43xx_current_phy(bcm)->type) {
2839 case BCM43xx_PHYTYPE_A:
2840 case BCM43xx_PHYTYPE_G:
2841 bcm43xx_rate_memory_write(bcm, IEEE80211_OFDM_RATE_6MB, 1);
2842 bcm43xx_rate_memory_write(bcm, IEEE80211_OFDM_RATE_12MB, 1);
2843 bcm43xx_rate_memory_write(bcm, IEEE80211_OFDM_RATE_18MB, 1);
2844 bcm43xx_rate_memory_write(bcm, IEEE80211_OFDM_RATE_24MB, 1);
2845 bcm43xx_rate_memory_write(bcm, IEEE80211_OFDM_RATE_36MB, 1);
2846 bcm43xx_rate_memory_write(bcm, IEEE80211_OFDM_RATE_48MB, 1);
2847 bcm43xx_rate_memory_write(bcm, IEEE80211_OFDM_RATE_54MB, 1);
2848 case BCM43xx_PHYTYPE_B:
2849 bcm43xx_rate_memory_write(bcm, IEEE80211_CCK_RATE_1MB, 0);
2850 bcm43xx_rate_memory_write(bcm, IEEE80211_CCK_RATE_2MB, 0);
2851 bcm43xx_rate_memory_write(bcm, IEEE80211_CCK_RATE_5MB, 0);
2852 bcm43xx_rate_memory_write(bcm, IEEE80211_CCK_RATE_11MB, 0);
2859 static void bcm43xx_wireless_core_cleanup(struct bcm43xx_private *bcm)
2861 bcm43xx_chip_cleanup(bcm);
2862 bcm43xx_pio_free(bcm);
2863 bcm43xx_dma_free(bcm);
2865 bcm->current_core->initialized = 0;
2868 /* http://bcm-specs.sipsolutions.net/80211Init */
2869 static int bcm43xx_wireless_core_init(struct bcm43xx_private *bcm)
2871 struct bcm43xx_phyinfo *phy = bcm43xx_current_phy(bcm);
2872 struct bcm43xx_radioinfo *radio = bcm43xx_current_radio(bcm);
2878 if (bcm->chip_rev < 5) {
2879 sbimconfiglow = bcm43xx_read32(bcm, BCM43xx_CIR_SBIMCONFIGLOW);
2880 sbimconfiglow &= ~ BCM43xx_SBIMCONFIGLOW_REQUEST_TOUT_MASK;
2881 sbimconfiglow &= ~ BCM43xx_SBIMCONFIGLOW_SERVICE_TOUT_MASK;
2882 if (bcm->bustype == BCM43xx_BUSTYPE_PCI)
2883 sbimconfiglow |= 0x32;
2884 else if (bcm->bustype == BCM43xx_BUSTYPE_SB)
2885 sbimconfiglow |= 0x53;
2888 bcm43xx_write32(bcm, BCM43xx_CIR_SBIMCONFIGLOW, sbimconfiglow);
2891 bcm43xx_phy_calibrate(bcm);
2892 err = bcm43xx_chip_init(bcm);
2896 bcm43xx_shm_write16(bcm, BCM43xx_SHM_SHARED, 0x0016, bcm->current_core->rev);
2897 ucodeflags = bcm43xx_shm_read32(bcm, BCM43xx_SHM_SHARED, BCM43xx_UCODEFLAGS_OFFSET);
2899 if (0 /*FIXME: which condition has to be used here? */)
2900 ucodeflags |= 0x00000010;
2902 /* HW decryption needs to be set now */
2903 ucodeflags |= 0x40000000;
2905 if (phy->type == BCM43xx_PHYTYPE_G) {
2906 ucodeflags |= BCM43xx_UCODEFLAG_UNKBGPHY;
2908 ucodeflags |= BCM43xx_UCODEFLAG_UNKGPHY;
2909 if (bcm->sprom.boardflags & BCM43xx_BFL_PACTRL)
2910 ucodeflags |= BCM43xx_UCODEFLAG_UNKPACTRL;
2911 } else if (phy->type == BCM43xx_PHYTYPE_B) {
2912 ucodeflags |= BCM43xx_UCODEFLAG_UNKBGPHY;
2913 if (phy->rev >= 2 && radio->version == 0x2050)
2914 ucodeflags &= ~BCM43xx_UCODEFLAG_UNKGPHY;
2917 if (ucodeflags != bcm43xx_shm_read32(bcm, BCM43xx_SHM_SHARED,
2918 BCM43xx_UCODEFLAGS_OFFSET)) {
2919 bcm43xx_shm_write32(bcm, BCM43xx_SHM_SHARED,
2920 BCM43xx_UCODEFLAGS_OFFSET, ucodeflags);
2923 /* Short/Long Retry Limit.
2924 * The retry-limit is a 4-bit counter. Enforce this to avoid overflowing
2925 * the chip-internal counter.
2927 limit = limit_value(modparam_short_retry, 0, 0xF);
2928 bcm43xx_shm_write32(bcm, BCM43xx_SHM_WIRELESS, 0x0006, limit);
2929 limit = limit_value(modparam_long_retry, 0, 0xF);
2930 bcm43xx_shm_write32(bcm, BCM43xx_SHM_WIRELESS, 0x0007, limit);
2932 bcm43xx_shm_write16(bcm, BCM43xx_SHM_SHARED, 0x0044, 3);
2933 bcm43xx_shm_write16(bcm, BCM43xx_SHM_SHARED, 0x0046, 2);
2935 bcm43xx_rate_memory_init(bcm);
2937 /* Minimum Contention Window */
2938 if (phy->type == BCM43xx_PHYTYPE_B)
2939 bcm43xx_shm_write32(bcm, BCM43xx_SHM_WIRELESS, 0x0003, 0x0000001f);
2941 bcm43xx_shm_write32(bcm, BCM43xx_SHM_WIRELESS, 0x0003, 0x0000000f);
2942 /* Maximum Contention Window */
2943 bcm43xx_shm_write32(bcm, BCM43xx_SHM_WIRELESS, 0x0004, 0x000003ff);
2945 bcm43xx_gen_bssid(bcm);
2946 bcm43xx_write_mac_bssid_templates(bcm);
2948 if (bcm->current_core->rev >= 5)
2949 bcm43xx_write16(bcm, 0x043C, 0x000C);
2951 if (bcm43xx_using_pio(bcm))
2952 err = bcm43xx_pio_init(bcm);
2954 err = bcm43xx_dma_init(bcm);
2956 goto err_chip_cleanup;
2957 bcm43xx_write16(bcm, 0x0612, 0x0050);
2958 bcm43xx_shm_write16(bcm, BCM43xx_SHM_SHARED, 0x0416, 0x0050);
2959 bcm43xx_shm_write16(bcm, BCM43xx_SHM_SHARED, 0x0414, 0x01F4);
2961 bcm43xx_mac_enable(bcm);
2962 bcm43xx_interrupt_enable(bcm, bcm->irq_savedstate);
2964 bcm->current_core->initialized = 1;
2969 bcm43xx_chip_cleanup(bcm);
2973 static int bcm43xx_chipset_attach(struct bcm43xx_private *bcm)
2978 err = bcm43xx_pctl_set_crystal(bcm, 1);
2981 bcm43xx_pci_read_config16(bcm, PCI_STATUS, &pci_status);
2982 bcm43xx_pci_write_config16(bcm, PCI_STATUS, pci_status & ~PCI_STATUS_SIG_TARGET_ABORT);
2988 static void bcm43xx_chipset_detach(struct bcm43xx_private *bcm)
2990 bcm43xx_pctl_set_clock(bcm, BCM43xx_PCTL_CLK_SLOW);
2991 bcm43xx_pctl_set_crystal(bcm, 0);
2994 static void bcm43xx_pcicore_broadcast_value(struct bcm43xx_private *bcm,
2998 bcm43xx_write32(bcm, BCM43xx_PCICORE_BCAST_ADDR, address);
2999 bcm43xx_write32(bcm, BCM43xx_PCICORE_BCAST_DATA, data);
3002 static int bcm43xx_pcicore_commit_settings(struct bcm43xx_private *bcm)
3005 struct bcm43xx_coreinfo *old_core;
3007 old_core = bcm->current_core;
3008 err = bcm43xx_switch_core(bcm, &bcm->core_pci);
3012 bcm43xx_pcicore_broadcast_value(bcm, 0xfd8, 0x00000000);
3014 bcm43xx_switch_core(bcm, old_core);
3020 /* Make an I/O Core usable. "core_mask" is the bitmask of the cores to enable.
3021 * To enable core 0, pass a core_mask of 1<<0
3023 static int bcm43xx_setup_backplane_pci_connection(struct bcm43xx_private *bcm,
3026 u32 backplane_flag_nr;
3028 struct bcm43xx_coreinfo *old_core;
3031 value = bcm43xx_read32(bcm, BCM43xx_CIR_SBTPSFLAG);
3032 backplane_flag_nr = value & BCM43xx_BACKPLANE_FLAG_NR_MASK;
3034 old_core = bcm->current_core;
3035 err = bcm43xx_switch_core(bcm, &bcm->core_pci);
3039 if (bcm->core_pci.rev < 6) {
3040 value = bcm43xx_read32(bcm, BCM43xx_CIR_SBINTVEC);
3041 value |= (1 << backplane_flag_nr);
3042 bcm43xx_write32(bcm, BCM43xx_CIR_SBINTVEC, value);
3044 err = bcm43xx_pci_read_config32(bcm, BCM43xx_PCICFG_ICR, &value);
3046 printk(KERN_ERR PFX "Error: ICR setup failure!\n");
3047 goto out_switch_back;
3049 value |= core_mask << 8;
3050 err = bcm43xx_pci_write_config32(bcm, BCM43xx_PCICFG_ICR, value);
3052 printk(KERN_ERR PFX "Error: ICR setup failure!\n");
3053 goto out_switch_back;
3057 value = bcm43xx_read32(bcm, BCM43xx_PCICORE_SBTOPCI2);
3058 value |= BCM43xx_SBTOPCI2_PREFETCH | BCM43xx_SBTOPCI2_BURST;
3059 bcm43xx_write32(bcm, BCM43xx_PCICORE_SBTOPCI2, value);
3061 if (bcm->core_pci.rev < 5) {
3062 value = bcm43xx_read32(bcm, BCM43xx_CIR_SBIMCONFIGLOW);
3063 value |= (2 << BCM43xx_SBIMCONFIGLOW_SERVICE_TOUT_SHIFT)
3064 & BCM43xx_SBIMCONFIGLOW_SERVICE_TOUT_MASK;
3065 value |= (3 << BCM43xx_SBIMCONFIGLOW_REQUEST_TOUT_SHIFT)
3066 & BCM43xx_SBIMCONFIGLOW_REQUEST_TOUT_MASK;
3067 bcm43xx_write32(bcm, BCM43xx_CIR_SBIMCONFIGLOW, value);
3068 err = bcm43xx_pcicore_commit_settings(bcm);
3073 err = bcm43xx_switch_core(bcm, old_core);
3078 static void bcm43xx_softmac_init(struct bcm43xx_private *bcm)
3080 ieee80211softmac_start(bcm->net_dev);
3083 static void bcm43xx_periodic_every120sec(struct bcm43xx_private *bcm)
3085 struct bcm43xx_phyinfo *phy = bcm43xx_current_phy(bcm);
3087 if (phy->type != BCM43xx_PHYTYPE_G || phy->rev < 2)
3090 bcm43xx_mac_suspend(bcm);
3091 bcm43xx_phy_lo_g_measure(bcm);
3092 bcm43xx_mac_enable(bcm);
3095 static void bcm43xx_periodic_every60sec(struct bcm43xx_private *bcm)
3097 bcm43xx_phy_lo_mark_all_unused(bcm);
3098 if (bcm->sprom.boardflags & BCM43xx_BFL_RSSI) {
3099 bcm43xx_mac_suspend(bcm);
3100 bcm43xx_calc_nrssi_slope(bcm);
3101 bcm43xx_mac_enable(bcm);
3105 static void bcm43xx_periodic_every30sec(struct bcm43xx_private *bcm)
3107 /* Update device statistics. */
3108 bcm43xx_calculate_link_quality(bcm);
3111 static void bcm43xx_periodic_every15sec(struct bcm43xx_private *bcm)
3113 struct bcm43xx_phyinfo *phy = bcm43xx_current_phy(bcm);
3114 struct bcm43xx_radioinfo *radio = bcm43xx_current_radio(bcm);
3116 if (phy->type == BCM43xx_PHYTYPE_G) {
3117 //TODO: update_aci_moving_average
3118 if (radio->aci_enable && radio->aci_wlan_automatic) {
3119 bcm43xx_mac_suspend(bcm);
3120 if (!radio->aci_enable && 1 /*TODO: not scanning? */) {
3121 if (0 /*TODO: bunch of conditions*/) {
3122 bcm43xx_radio_set_interference_mitigation(bcm,
3123 BCM43xx_RADIO_INTERFMODE_MANUALWLAN);
3125 } else if (1/*TODO*/) {
3127 if ((aci_average > 1000) && !(bcm43xx_radio_aci_scan(bcm))) {
3128 bcm43xx_radio_set_interference_mitigation(bcm,
3129 BCM43xx_RADIO_INTERFMODE_NONE);
3133 bcm43xx_mac_enable(bcm);
3134 } else if (radio->interfmode == BCM43xx_RADIO_INTERFMODE_NONWLAN &&
3136 //TODO: implement rev1 workaround
3139 bcm43xx_phy_xmitpower(bcm); //FIXME: unless scanning?
3140 //TODO for APHY (temperature?)
3143 static void do_periodic_work(struct bcm43xx_private *bcm)
3147 state = bcm->periodic_state;
3149 bcm43xx_periodic_every120sec(bcm);
3151 bcm43xx_periodic_every60sec(bcm);
3153 bcm43xx_periodic_every30sec(bcm);
3155 bcm43xx_periodic_every15sec(bcm);
3156 bcm->periodic_state = state + 1;
3158 schedule_delayed_work(&bcm->periodic_work, HZ * 15);
3161 /* Estimate a "Badness" value based on the periodic work
3162 * state-machine state. "Badness" is worse (bigger), if the
3163 * periodic work will take longer.
3165 static int estimate_periodic_work_badness(unsigned int state)
3169 if (state % 8 == 0) /* every 120 sec */
3171 if (state % 4 == 0) /* every 60 sec */
3173 if (state % 2 == 0) /* every 30 sec */
3175 if (state % 1 == 0) /* every 15 sec */
3178 #define BADNESS_LIMIT 4
3182 static void bcm43xx_periodic_work_handler(void *d)
3184 struct bcm43xx_private *bcm = d;
3185 unsigned long flags;
3189 badness = estimate_periodic_work_badness(bcm->periodic_state);
3190 if (badness > BADNESS_LIMIT) {
3191 /* Periodic work will take a long time, so we want it to
3194 netif_stop_queue(bcm->net_dev);
3196 spin_lock_irqsave(&bcm->irq_lock, flags);
3197 bcm43xx_mac_suspend(bcm);
3198 if (bcm43xx_using_pio(bcm))
3199 bcm43xx_pio_freeze_txqueues(bcm);
3200 savedirqs = bcm43xx_interrupt_disable(bcm, BCM43xx_IRQ_ALL);
3201 spin_unlock_irqrestore(&bcm->irq_lock, flags);
3202 mutex_lock(&bcm->mutex);
3203 bcm43xx_synchronize_irq(bcm);
3205 /* Periodic work should take short time, so we want low
3208 mutex_lock(&bcm->mutex);
3209 spin_lock_irqsave(&bcm->irq_lock, flags);
3212 do_periodic_work(bcm);
3214 if (badness > BADNESS_LIMIT) {
3215 spin_lock_irqsave(&bcm->irq_lock, flags);
3216 if (likely(bcm43xx_status(bcm) == BCM43xx_STAT_INITIALIZED)) {
3217 tasklet_enable(&bcm->isr_tasklet);
3218 bcm43xx_interrupt_enable(bcm, savedirqs);
3219 if (bcm43xx_using_pio(bcm))
3220 bcm43xx_pio_thaw_txqueues(bcm);
3221 bcm43xx_mac_enable(bcm);
3223 netif_wake_queue(bcm->net_dev);
3226 spin_unlock_irqrestore(&bcm->irq_lock, flags);
3227 mutex_unlock(&bcm->mutex);
3230 static void bcm43xx_periodic_tasks_delete(struct bcm43xx_private *bcm)
3232 cancel_rearming_delayed_work(&bcm->periodic_work);
3235 static void bcm43xx_periodic_tasks_setup(struct bcm43xx_private *bcm)
3237 struct work_struct *work = &(bcm->periodic_work);
3239 assert(bcm43xx_status(bcm) == BCM43xx_STAT_INITIALIZED);
3240 INIT_WORK(work, bcm43xx_periodic_work_handler, bcm);
3241 schedule_work(work);
3244 static void bcm43xx_security_init(struct bcm43xx_private *bcm)
3246 bcm->security_offset = bcm43xx_shm_read16(bcm, BCM43xx_SHM_SHARED,
3248 bcm43xx_clear_keys(bcm);
3251 static int bcm43xx_rng_read(struct hwrng *rng, u32 *data)
3253 struct bcm43xx_private *bcm = (struct bcm43xx_private *)rng->priv;
3254 unsigned long flags;
3256 bcm43xx_lock_irqonly(bcm, flags);
3257 *data = bcm43xx_read16(bcm, BCM43xx_MMIO_RNG);
3258 bcm43xx_unlock_irqonly(bcm, flags);
3260 return (sizeof(u16));
3263 static void bcm43xx_rng_exit(struct bcm43xx_private *bcm)
3265 hwrng_unregister(&bcm->rng);
3268 static int bcm43xx_rng_init(struct bcm43xx_private *bcm)
3272 snprintf(bcm->rng_name, ARRAY_SIZE(bcm->rng_name),
3273 "%s_%s", KBUILD_MODNAME, bcm->net_dev->name);
3274 bcm->rng.name = bcm->rng_name;
3275 bcm->rng.data_read = bcm43xx_rng_read;
3276 bcm->rng.priv = (unsigned long)bcm;
3277 err = hwrng_register(&bcm->rng);
3279 printk(KERN_ERR PFX "RNG init failed (%d)\n", err);
3284 /* This is the opposite of bcm43xx_init_board() */
3285 static void bcm43xx_free_board(struct bcm43xx_private *bcm)
3289 mutex_lock(&bcm->mutex);
3290 bcm43xx_sysfs_unregister(bcm);
3291 bcm43xx_periodic_tasks_delete(bcm);
3293 bcm43xx_set_status(bcm, BCM43xx_STAT_SHUTTINGDOWN);
3295 bcm43xx_rng_exit(bcm);
3296 for (i = 0; i < BCM43xx_MAX_80211_CORES; i++) {
3297 if (!bcm->core_80211[i].available)
3299 if (!bcm->core_80211[i].initialized)
3302 err = bcm43xx_switch_core(bcm, &bcm->core_80211[i]);
3304 bcm43xx_wireless_core_cleanup(bcm);
3307 bcm43xx_pctl_set_crystal(bcm, 0);
3309 bcm43xx_set_status(bcm, BCM43xx_STAT_UNINIT);
3310 mutex_unlock(&bcm->mutex);
3313 static int bcm43xx_init_board(struct bcm43xx_private *bcm)
3320 mutex_lock(&bcm->mutex);
3321 bcm43xx_set_status(bcm, BCM43xx_STAT_INITIALIZING);
3323 bcm->mac_suspended = 1;
3325 err = bcm43xx_pctl_set_crystal(bcm, 1);
3328 err = bcm43xx_pctl_init(bcm);
3330 goto err_crystal_off;
3331 err = bcm43xx_pctl_set_clock(bcm, BCM43xx_PCTL_CLK_FAST);
3333 goto err_crystal_off;
3335 tasklet_enable(&bcm->isr_tasklet);
3336 for (i = 0; i < bcm->nr_80211_available; i++) {
3337 err = bcm43xx_switch_core(bcm, &bcm->core_80211[i]);
3338 assert(err != -ENODEV);
3340 goto err_80211_unwind;
3342 /* Enable the selected wireless core.
3343 * Connect PHY only on the first core.
3345 if (!bcm43xx_core_enabled(bcm)) {
3346 if (bcm->nr_80211_available == 1) {
3347 connect_phy = bcm43xx_current_phy(bcm)->connected;
3354 bcm43xx_wireless_core_reset(bcm, connect_phy);
3358 bcm43xx_wireless_core_mark_inactive(bcm, &bcm->core_80211[0]);
3360 err = bcm43xx_wireless_core_init(bcm);
3362 goto err_80211_unwind;
3365 bcm43xx_mac_suspend(bcm);
3366 bcm43xx_interrupt_disable(bcm, BCM43xx_IRQ_ALL);
3367 bcm43xx_radio_turn_off(bcm);
3370 bcm->active_80211_core = &bcm->core_80211[0];
3371 if (bcm->nr_80211_available >= 2) {
3372 bcm43xx_switch_core(bcm, &bcm->core_80211[0]);
3373 bcm43xx_mac_enable(bcm);
3375 err = bcm43xx_rng_init(bcm);
3377 goto err_80211_unwind;
3378 bcm43xx_macfilter_clear(bcm, BCM43xx_MACFILTER_ASSOC);
3379 bcm43xx_macfilter_set(bcm, BCM43xx_MACFILTER_SELF, (u8 *)(bcm->net_dev->dev_addr));
3380 dprintk(KERN_INFO PFX "80211 cores initialized\n");
3381 bcm43xx_security_init(bcm);
3382 bcm43xx_softmac_init(bcm);
3384 bcm43xx_pctl_set_clock(bcm, BCM43xx_PCTL_CLK_DYNAMIC);
3386 if (bcm43xx_current_radio(bcm)->initial_channel != 0xFF) {
3387 bcm43xx_mac_suspend(bcm);
3388 bcm43xx_radio_selectchannel(bcm, bcm43xx_current_radio(bcm)->initial_channel, 0);
3389 bcm43xx_mac_enable(bcm);
3392 /* Initialization of the board is done. Flag it as such. */
3393 bcm43xx_set_status(bcm, BCM43xx_STAT_INITIALIZED);
3395 bcm43xx_periodic_tasks_setup(bcm);
3396 bcm43xx_sysfs_register(bcm);
3397 //FIXME: check for bcm43xx_sysfs_register failure. This function is a bit messy regarding unwinding, though...
3399 /*FIXME: This should be handled by softmac instead. */
3400 schedule_work(&bcm->softmac->associnfo.work);
3404 mutex_unlock(&bcm->mutex);
3409 tasklet_disable(&bcm->isr_tasklet);
3410 /* unwind all 80211 initialization */
3411 for (i = 0; i < bcm->nr_80211_available; i++) {
3412 if (!bcm->core_80211[i].initialized)
3414 bcm43xx_interrupt_disable(bcm, BCM43xx_IRQ_ALL);
3415 bcm43xx_wireless_core_cleanup(bcm);
3418 bcm43xx_pctl_set_crystal(bcm, 0);
3422 static void bcm43xx_detach_board(struct bcm43xx_private *bcm)
3424 struct pci_dev *pci_dev = bcm->pci_dev;
3427 bcm43xx_chipset_detach(bcm);
3428 /* Do _not_ access the chip, after it is detached. */
3429 pci_iounmap(pci_dev, bcm->mmio_addr);
3430 pci_release_regions(pci_dev);
3431 pci_disable_device(pci_dev);
3433 /* Free allocated structures/fields */
3434 for (i = 0; i < BCM43xx_MAX_80211_CORES; i++) {
3435 kfree(bcm->core_80211_ext[i].phy._lo_pairs);
3436 if (bcm->core_80211_ext[i].phy.dyn_tssi_tbl)
3437 kfree(bcm->core_80211_ext[i].phy.tssi2dbm);
3441 static int bcm43xx_read_phyinfo(struct bcm43xx_private *bcm)
3443 struct bcm43xx_phyinfo *phy = bcm43xx_current_phy(bcm);
3451 value = bcm43xx_read16(bcm, BCM43xx_MMIO_PHY_VER);
3453 phy_version = (value & 0xF000) >> 12;
3454 phy_type = (value & 0x0F00) >> 8;
3455 phy_rev = (value & 0x000F);
3457 dprintk(KERN_INFO PFX "Detected PHY: Version: %x, Type %x, Revision %x\n",
3458 phy_version, phy_type, phy_rev);
3461 case BCM43xx_PHYTYPE_A:
3464 /*FIXME: We need to switch the ieee->modulation, etc.. flags,
3465 * if we switch 80211 cores after init is done.
3466 * As we do not implement on the fly switching between
3467 * wireless cores, I will leave this as a future task.
3469 bcm->ieee->modulation = IEEE80211_OFDM_MODULATION;
3470 bcm->ieee->mode = IEEE_A;
3471 bcm->ieee->freq_band = IEEE80211_52GHZ_BAND |
3472 IEEE80211_24GHZ_BAND;
3474 case BCM43xx_PHYTYPE_B:
3475 if (phy_rev != 2 && phy_rev != 4 && phy_rev != 6 && phy_rev != 7)
3477 bcm->ieee->modulation = IEEE80211_CCK_MODULATION;
3478 bcm->ieee->mode = IEEE_B;
3479 bcm->ieee->freq_band = IEEE80211_24GHZ_BAND;
3481 case BCM43xx_PHYTYPE_G:
3484 bcm->ieee->modulation = IEEE80211_OFDM_MODULATION |
3485 IEEE80211_CCK_MODULATION;
3486 bcm->ieee->mode = IEEE_G;
3487 bcm->ieee->freq_band = IEEE80211_24GHZ_BAND;
3490 printk(KERN_ERR PFX "Error: Unknown PHY Type %x\n",
3495 printk(KERN_WARNING PFX "Invalid PHY Revision %x\n",
3499 phy->version = phy_version;
3500 phy->type = phy_type;
3502 if ((phy_type == BCM43xx_PHYTYPE_B) || (phy_type == BCM43xx_PHYTYPE_G)) {
3503 p = kzalloc(sizeof(struct bcm43xx_lopair) * BCM43xx_LO_COUNT,
3513 static int bcm43xx_attach_board(struct bcm43xx_private *bcm)
3515 struct pci_dev *pci_dev = bcm->pci_dev;
3516 struct net_device *net_dev = bcm->net_dev;
3521 err = pci_enable_device(pci_dev);
3523 printk(KERN_ERR PFX "pci_enable_device() failed\n");
3526 err = pci_request_regions(pci_dev, KBUILD_MODNAME);
3528 printk(KERN_ERR PFX "pci_request_regions() failed\n");
3529 goto err_pci_disable;
3531 /* enable PCI bus-mastering */
3532 pci_set_master(pci_dev);
3533 bcm->mmio_addr = pci_iomap(pci_dev, 0, ~0UL);
3534 if (!bcm->mmio_addr) {
3535 printk(KERN_ERR PFX "pci_iomap() failed\n");
3537 goto err_pci_release;
3539 net_dev->base_addr = (unsigned long)bcm->mmio_addr;
3541 bcm43xx_pci_read_config16(bcm, PCI_SUBSYSTEM_VENDOR_ID,
3542 &bcm->board_vendor);
3543 bcm43xx_pci_read_config16(bcm, PCI_SUBSYSTEM_ID,
3545 bcm43xx_pci_read_config16(bcm, PCI_REVISION_ID,
3546 &bcm->board_revision);
3548 err = bcm43xx_chipset_attach(bcm);
3551 err = bcm43xx_pctl_init(bcm);
3553 goto err_chipset_detach;
3554 err = bcm43xx_probe_cores(bcm);
3556 goto err_chipset_detach;
3558 /* Attach all IO cores to the backplane. */
3560 for (i = 0; i < bcm->nr_80211_available; i++)
3561 coremask |= (1 << bcm->core_80211[i].index);
3562 //FIXME: Also attach some non80211 cores?
3563 err = bcm43xx_setup_backplane_pci_connection(bcm, coremask);
3565 printk(KERN_ERR PFX "Backplane->PCI connection failed!\n");
3566 goto err_chipset_detach;
3569 err = bcm43xx_sprom_extract(bcm);
3571 goto err_chipset_detach;
3572 err = bcm43xx_leds_init(bcm);
3574 goto err_chipset_detach;
3576 for (i = 0; i < bcm->nr_80211_available; i++) {
3577 err = bcm43xx_switch_core(bcm, &bcm->core_80211[i]);
3578 assert(err != -ENODEV);
3580 goto err_80211_unwind;
3582 /* Enable the selected wireless core.
3583 * Connect PHY only on the first core.
3585 bcm43xx_wireless_core_reset(bcm, (i == 0));
3587 err = bcm43xx_read_phyinfo(bcm);
3588 if (err && (i == 0))
3589 goto err_80211_unwind;
3591 err = bcm43xx_read_radioinfo(bcm);
3592 if (err && (i == 0))
3593 goto err_80211_unwind;
3595 err = bcm43xx_validate_chip(bcm);
3596 if (err && (i == 0))
3597 goto err_80211_unwind;
3599 bcm43xx_radio_turn_off(bcm);
3600 err = bcm43xx_phy_init_tssi2dbm_table(bcm);
3602 goto err_80211_unwind;
3603 bcm43xx_wireless_core_disable(bcm);
3605 err = bcm43xx_geo_init(bcm);
3607 goto err_80211_unwind;
3608 bcm43xx_pctl_set_crystal(bcm, 0);
3610 /* Set the MAC address in the networking subsystem */
3611 if (is_valid_ether_addr(bcm->sprom.et1macaddr))
3612 memcpy(bcm->net_dev->dev_addr, bcm->sprom.et1macaddr, 6);
3614 memcpy(bcm->net_dev->dev_addr, bcm->sprom.il0macaddr, 6);
3616 snprintf(bcm->nick, IW_ESSID_MAX_SIZE,
3617 "Broadcom %04X", bcm->chip_id);
3624 for (i = 0; i < BCM43xx_MAX_80211_CORES; i++) {
3625 kfree(bcm->core_80211_ext[i].phy._lo_pairs);
3626 if (bcm->core_80211_ext[i].phy.dyn_tssi_tbl)
3627 kfree(bcm->core_80211_ext[i].phy.tssi2dbm);
3630 bcm43xx_chipset_detach(bcm);
3632 pci_iounmap(pci_dev, bcm->mmio_addr);
3634 pci_release_regions(pci_dev);
3636 pci_disable_device(pci_dev);
3640 /* Do the Hardware IO operations to send the txb */
3641 static inline int bcm43xx_tx(struct bcm43xx_private *bcm,
3642 struct ieee80211_txb *txb)
3646 if (bcm43xx_using_pio(bcm))
3647 err = bcm43xx_pio_tx(bcm, txb);
3649 err = bcm43xx_dma_tx(bcm, txb);
3650 bcm->net_dev->trans_start = jiffies;
3655 static void bcm43xx_ieee80211_set_chan(struct net_device *net_dev,
3658 struct bcm43xx_private *bcm = bcm43xx_priv(net_dev);
3659 struct bcm43xx_radioinfo *radio;
3660 unsigned long flags;
3662 mutex_lock(&bcm->mutex);
3663 spin_lock_irqsave(&bcm->irq_lock, flags);
3664 if (bcm43xx_status(bcm) == BCM43xx_STAT_INITIALIZED) {
3665 bcm43xx_mac_suspend(bcm);
3666 bcm43xx_radio_selectchannel(bcm, channel, 0);
3667 bcm43xx_mac_enable(bcm);
3669 radio = bcm43xx_current_radio(bcm);
3670 radio->initial_channel = channel;
3672 spin_unlock_irqrestore(&bcm->irq_lock, flags);
3673 mutex_unlock(&bcm->mutex);
3676 /* set_security() callback in struct ieee80211_device */
3677 static void bcm43xx_ieee80211_set_security(struct net_device *net_dev,
3678 struct ieee80211_security *sec)
3680 struct bcm43xx_private *bcm = bcm43xx_priv(net_dev);
3681 struct ieee80211_security *secinfo = &bcm->ieee->sec;
3682 unsigned long flags;
3685 dprintk(KERN_INFO PFX "set security called");
3687 mutex_lock(&bcm->mutex);
3688 spin_lock_irqsave(&bcm->irq_lock, flags);
3690 for (keyidx = 0; keyidx<WEP_KEYS; keyidx++)
3691 if (sec->flags & (1<<keyidx)) {
3692 secinfo->encode_alg[keyidx] = sec->encode_alg[keyidx];
3693 secinfo->key_sizes[keyidx] = sec->key_sizes[keyidx];
3694 memcpy(secinfo->keys[keyidx], sec->keys[keyidx], SCM_KEY_LEN);
3697 if (sec->flags & SEC_ACTIVE_KEY) {
3698 secinfo->active_key = sec->active_key;
3699 dprintk(", .active_key = %d", sec->active_key);
3701 if (sec->flags & SEC_UNICAST_GROUP) {
3702 secinfo->unicast_uses_group = sec->unicast_uses_group;
3703 dprintk(", .unicast_uses_group = %d", sec->unicast_uses_group);
3705 if (sec->flags & SEC_LEVEL) {
3706 secinfo->level = sec->level;
3707 dprintk(", .level = %d", sec->level);
3709 if (sec->flags & SEC_ENABLED) {
3710 secinfo->enabled = sec->enabled;
3711 dprintk(", .enabled = %d", sec->enabled);
3713 if (sec->flags & SEC_ENCRYPT) {
3714 secinfo->encrypt = sec->encrypt;
3715 dprintk(", .encrypt = %d", sec->encrypt);
3717 if (sec->flags & SEC_AUTH_MODE) {
3718 secinfo->auth_mode = sec->auth_mode;
3719 dprintk(", .auth_mode = %d", sec->auth_mode);
3722 if (bcm43xx_status(bcm) == BCM43xx_STAT_INITIALIZED &&
3723 !bcm->ieee->host_encrypt) {
3724 if (secinfo->enabled) {
3725 /* upload WEP keys to hardware */
3726 char null_address[6] = { 0 };
3728 for (keyidx = 0; keyidx<WEP_KEYS; keyidx++) {
3729 if (!(sec->flags & (1<<keyidx)))
3731 switch (sec->encode_alg[keyidx]) {
3732 case SEC_ALG_NONE: algorithm = BCM43xx_SEC_ALGO_NONE; break;
3734 algorithm = BCM43xx_SEC_ALGO_WEP;
3735 if (secinfo->key_sizes[keyidx] == 13)
3736 algorithm = BCM43xx_SEC_ALGO_WEP104;
3740 algorithm = BCM43xx_SEC_ALGO_TKIP;
3744 algorithm = BCM43xx_SEC_ALGO_AES;
3750 bcm43xx_key_write(bcm, keyidx, algorithm, sec->keys[keyidx], secinfo->key_sizes[keyidx], &null_address[0]);
3751 bcm->key[keyidx].enabled = 1;
3752 bcm->key[keyidx].algorithm = algorithm;
3755 bcm43xx_clear_keys(bcm);
3757 spin_unlock_irqrestore(&bcm->irq_lock, flags);
3758 mutex_unlock(&bcm->mutex);
3761 /* hard_start_xmit() callback in struct ieee80211_device */
3762 static int bcm43xx_ieee80211_hard_start_xmit(struct ieee80211_txb *txb,
3763 struct net_device *net_dev,
3766 struct bcm43xx_private *bcm = bcm43xx_priv(net_dev);
3768 unsigned long flags;
3770 spin_lock_irqsave(&bcm->irq_lock, flags);
3771 if (likely(bcm43xx_status(bcm) == BCM43xx_STAT_INITIALIZED))
3772 err = bcm43xx_tx(bcm, txb);
3773 spin_unlock_irqrestore(&bcm->irq_lock, flags);
3778 static struct net_device_stats * bcm43xx_net_get_stats(struct net_device *net_dev)
3780 return &(bcm43xx_priv(net_dev)->ieee->stats);
3783 static void bcm43xx_net_tx_timeout(struct net_device *net_dev)
3785 struct bcm43xx_private *bcm = bcm43xx_priv(net_dev);
3786 unsigned long flags;
3788 spin_lock_irqsave(&bcm->irq_lock, flags);
3789 bcm43xx_controller_restart(bcm, "TX timeout");
3790 spin_unlock_irqrestore(&bcm->irq_lock, flags);
3793 #ifdef CONFIG_NET_POLL_CONTROLLER
3794 static void bcm43xx_net_poll_controller(struct net_device *net_dev)
3796 struct bcm43xx_private *bcm = bcm43xx_priv(net_dev);
3797 unsigned long flags;
3799 local_irq_save(flags);
3800 bcm43xx_interrupt_handler(bcm->irq, bcm, NULL);
3801 local_irq_restore(flags);
3803 #endif /* CONFIG_NET_POLL_CONTROLLER */
3805 static int bcm43xx_net_open(struct net_device *net_dev)
3807 struct bcm43xx_private *bcm = bcm43xx_priv(net_dev);
3809 return bcm43xx_init_board(bcm);
3812 static int bcm43xx_net_stop(struct net_device *net_dev)
3814 struct bcm43xx_private *bcm = bcm43xx_priv(net_dev);
3817 ieee80211softmac_stop(net_dev);
3818 err = bcm43xx_disable_interrupts_sync(bcm, NULL);
3820 bcm43xx_free_board(bcm);
3825 static int bcm43xx_init_private(struct bcm43xx_private *bcm,
3826 struct net_device *net_dev,
3827 struct pci_dev *pci_dev)
3831 bcm43xx_set_status(bcm, BCM43xx_STAT_UNINIT);
3832 bcm->ieee = netdev_priv(net_dev);
3833 bcm->softmac = ieee80211_priv(net_dev);
3834 bcm->softmac->set_channel = bcm43xx_ieee80211_set_chan;
3836 bcm->irq_savedstate = BCM43xx_IRQ_INITIAL;
3837 bcm->pci_dev = pci_dev;
3838 bcm->net_dev = net_dev;
3839 bcm->bad_frames_preempt = modparam_bad_frames_preempt;
3840 spin_lock_init(&bcm->irq_lock);
3841 spin_lock_init(&bcm->leds_lock);
3842 mutex_init(&bcm->mutex);
3843 tasklet_init(&bcm->isr_tasklet,
3844 (void (*)(unsigned long))bcm43xx_interrupt_tasklet,
3845 (unsigned long)bcm);
3846 tasklet_disable_nosync(&bcm->isr_tasklet);
3848 bcm->__using_pio = 1;
3850 err = pci_set_dma_mask(pci_dev, DMA_30BIT_MASK);
3851 err |= pci_set_consistent_dma_mask(pci_dev, DMA_30BIT_MASK);
3853 #ifdef CONFIG_BCM43XX_PIO
3854 printk(KERN_WARNING PFX "DMA not supported. Falling back to PIO.\n");
3855 bcm->__using_pio = 1;
3857 printk(KERN_ERR PFX "FATAL: DMA not supported and PIO not configured. "
3858 "Recompile the driver with PIO support, please.\n");
3860 #endif /* CONFIG_BCM43XX_PIO */
3863 bcm->rts_threshold = BCM43xx_DEFAULT_RTS_THRESHOLD;
3865 /* default to sw encryption for now */
3866 bcm->ieee->host_build_iv = 0;
3867 bcm->ieee->host_encrypt = 1;
3868 bcm->ieee->host_decrypt = 1;
3870 bcm->ieee->iw_mode = BCM43xx_INITIAL_IWMODE;
3871 bcm->ieee->tx_headroom = sizeof(struct bcm43xx_txhdr);
3872 bcm->ieee->set_security = bcm43xx_ieee80211_set_security;
3873 bcm->ieee->hard_start_xmit = bcm43xx_ieee80211_hard_start_xmit;
3878 static int __devinit bcm43xx_init_one(struct pci_dev *pdev,
3879 const struct pci_device_id *ent)
3881 struct net_device *net_dev;
3882 struct bcm43xx_private *bcm;
3885 #ifdef CONFIG_BCM947XX
3886 if ((pdev->bus->number == 0) && (pdev->device != 0x0800))
3890 #ifdef DEBUG_SINGLE_DEVICE_ONLY
3891 if (strcmp(pci_name(pdev), DEBUG_SINGLE_DEVICE_ONLY))
3895 net_dev = alloc_ieee80211softmac(sizeof(*bcm));
3898 "could not allocate ieee80211 device %s\n",
3903 /* initialize the net_device struct */
3904 SET_MODULE_OWNER(net_dev);
3905 SET_NETDEV_DEV(net_dev, &pdev->dev);
3907 net_dev->open = bcm43xx_net_open;
3908 net_dev->stop = bcm43xx_net_stop;
3909 net_dev->get_stats = bcm43xx_net_get_stats;
3910 net_dev->tx_timeout = bcm43xx_net_tx_timeout;
3911 #ifdef CONFIG_NET_POLL_CONTROLLER
3912 net_dev->poll_controller = bcm43xx_net_poll_controller;
3914 net_dev->wireless_handlers = &bcm43xx_wx_handlers_def;
3915 net_dev->irq = pdev->irq;
3916 SET_ETHTOOL_OPS(net_dev, &bcm43xx_ethtool_ops);
3918 /* initialize the bcm43xx_private struct */
3919 bcm = bcm43xx_priv(net_dev);
3920 memset(bcm, 0, sizeof(*bcm));
3921 err = bcm43xx_init_private(bcm, net_dev, pdev);
3923 goto err_free_netdev;
3925 pci_set_drvdata(pdev, net_dev);
3927 err = bcm43xx_attach_board(bcm);
3929 goto err_free_netdev;
3931 err = register_netdev(net_dev);
3933 printk(KERN_ERR PFX "Cannot register net device, "
3936 goto err_detach_board;
3939 bcm43xx_debugfs_add_device(bcm);
3946 bcm43xx_detach_board(bcm);
3948 free_ieee80211softmac(net_dev);
3952 static void __devexit bcm43xx_remove_one(struct pci_dev *pdev)
3954 struct net_device *net_dev = pci_get_drvdata(pdev);
3955 struct bcm43xx_private *bcm = bcm43xx_priv(net_dev);
3957 bcm43xx_debugfs_remove_device(bcm);
3958 unregister_netdev(net_dev);
3959 bcm43xx_detach_board(bcm);
3960 assert(bcm->ucode == NULL);
3961 free_ieee80211softmac(net_dev);
3964 /* Hard-reset the chip. Do not call this directly.
3965 * Use bcm43xx_controller_restart()
3967 static void bcm43xx_chip_reset(void *_bcm)
3969 struct bcm43xx_private *bcm = _bcm;
3970 struct net_device *net_dev = bcm->net_dev;
3971 struct pci_dev *pci_dev = bcm->pci_dev;
3973 int was_initialized = (bcm43xx_status(bcm) == BCM43xx_STAT_INITIALIZED);
3975 netif_stop_queue(bcm->net_dev);
3976 tasklet_disable(&bcm->isr_tasklet);
3978 bcm->firmware_norelease = 1;
3979 if (was_initialized)
3980 bcm43xx_free_board(bcm);
3981 bcm->firmware_norelease = 0;
3982 bcm43xx_detach_board(bcm);
3983 err = bcm43xx_init_private(bcm, net_dev, pci_dev);
3986 err = bcm43xx_attach_board(bcm);
3989 if (was_initialized) {
3990 err = bcm43xx_init_board(bcm);
3994 netif_wake_queue(bcm->net_dev);
3995 printk(KERN_INFO PFX "Controller restarted\n");
3999 printk(KERN_ERR PFX "Controller restart failed\n");
4002 /* Hard-reset the chip.
4003 * This can be called from interrupt or process context.
4004 * Make sure to _not_ re-enable device interrupts after this has been called.
4006 void bcm43xx_controller_restart(struct bcm43xx_private *bcm, const char *reason)
4008 bcm43xx_set_status(bcm, BCM43xx_STAT_RESTARTING);
4009 bcm43xx_interrupt_disable(bcm, BCM43xx_IRQ_ALL);
4010 bcm43xx_read32(bcm, BCM43xx_MMIO_STATUS_BITFIELD); /* dummy read */
4011 printk(KERN_ERR PFX "Controller RESET (%s) ...\n", reason);
4012 INIT_WORK(&bcm->restart_work, bcm43xx_chip_reset, bcm);
4013 schedule_work(&bcm->restart_work);
4018 static int bcm43xx_suspend(struct pci_dev *pdev, pm_message_t state)
4020 struct net_device *net_dev = pci_get_drvdata(pdev);
4021 struct bcm43xx_private *bcm = bcm43xx_priv(net_dev);
4022 int try_to_shutdown = 0, err;
4024 dprintk(KERN_INFO PFX "Suspending...\n");
4026 bcm->was_initialized = (bcm43xx_status(bcm) == BCM43xx_STAT_INITIALIZED);
4027 if (bcm->was_initialized)
4028 try_to_shutdown = 1;
4030 netif_device_detach(net_dev);
4031 if (try_to_shutdown) {
4032 ieee80211softmac_stop(net_dev);
4033 err = bcm43xx_disable_interrupts_sync(bcm, &bcm->irq_savedstate);
4034 if (unlikely(err)) {
4035 dprintk(KERN_ERR PFX "Suspend failed.\n");
4038 bcm->firmware_norelease = 1;
4039 bcm43xx_free_board(bcm);
4040 bcm->firmware_norelease = 0;
4042 bcm43xx_chipset_detach(bcm);
4044 pci_save_state(pdev);
4045 pci_disable_device(pdev);
4046 pci_set_power_state(pdev, pci_choose_state(pdev, state));
4048 dprintk(KERN_INFO PFX "Device suspended.\n");
4053 static int bcm43xx_resume(struct pci_dev *pdev)
4055 struct net_device *net_dev = pci_get_drvdata(pdev);
4056 struct bcm43xx_private *bcm = bcm43xx_priv(net_dev);
4059 dprintk(KERN_INFO PFX "Resuming...\n");
4061 pci_set_power_state(pdev, 0);
4062 pci_enable_device(pdev);
4063 pci_restore_state(pdev);
4065 bcm43xx_chipset_attach(bcm);
4066 if (bcm->was_initialized) {
4067 bcm->irq_savedstate = BCM43xx_IRQ_INITIAL;
4068 err = bcm43xx_init_board(bcm);
4071 printk(KERN_ERR PFX "Resume failed!\n");
4075 netif_device_attach(net_dev);
4077 dprintk(KERN_INFO PFX "Device resumed.\n");
4082 #endif /* CONFIG_PM */
4084 static struct pci_driver bcm43xx_pci_driver = {
4085 .name = KBUILD_MODNAME,
4086 .id_table = bcm43xx_pci_tbl,
4087 .probe = bcm43xx_init_one,
4088 .remove = __devexit_p(bcm43xx_remove_one),
4090 .suspend = bcm43xx_suspend,
4091 .resume = bcm43xx_resume,
4092 #endif /* CONFIG_PM */
4095 static int __init bcm43xx_init(void)
4097 printk(KERN_INFO KBUILD_MODNAME " driver\n");
4098 bcm43xx_debugfs_init();
4099 return pci_register_driver(&bcm43xx_pci_driver);
4102 static void __exit bcm43xx_exit(void)
4104 pci_unregister_driver(&bcm43xx_pci_driver);
4105 bcm43xx_debugfs_exit();
4108 module_init(bcm43xx_init)
4109 module_exit(bcm43xx_exit)