mirror of
https://github.com/openwrt/openwrt.git
synced 2024-12-24 15:56:49 +00:00
32d1e0ed2c
Signed-off-by: Felix Fietkau <nbd@openwrt.org> SVN-Revision: 40833
1279 lines
41 KiB
Diff
1279 lines
41 KiB
Diff
--- a/drivers/ssb/Kconfig
|
|
+++ b/drivers/ssb/Kconfig
|
|
@@ -138,13 +138,13 @@ config SSB_DRIVER_MIPS
|
|
|
|
config SSB_SFLASH
|
|
bool "SSB serial flash support"
|
|
- depends on SSB_DRIVER_MIPS && BROKEN
|
|
+ depends on SSB_DRIVER_MIPS
|
|
default y
|
|
|
|
# Assumption: We are on embedded, if we compile the MIPS core.
|
|
config SSB_EMBEDDED
|
|
bool
|
|
- depends on SSB_DRIVER_MIPS
|
|
+ depends on SSB_DRIVER_MIPS && SSB_PCICORE_HOSTMODE
|
|
default y
|
|
|
|
config SSB_DRIVER_EXTIF
|
|
--- a/drivers/ssb/driver_chipcommon.c
|
|
+++ b/drivers/ssb/driver_chipcommon.c
|
|
@@ -354,7 +354,7 @@ void ssb_chipcommon_init(struct ssb_chip
|
|
|
|
if (cc->dev->id.revision >= 11)
|
|
cc->status = chipco_read32(cc, SSB_CHIPCO_CHIPSTAT);
|
|
- ssb_dprintk(KERN_INFO PFX "chipcommon status is 0x%x\n", cc->status);
|
|
+ ssb_dbg("chipcommon status is 0x%x\n", cc->status);
|
|
|
|
if (cc->dev->id.revision >= 20) {
|
|
chipco_write32(cc, SSB_CHIPCO_GPIOPULLUP, 0);
|
|
--- a/drivers/ssb/driver_chipcommon_pmu.c
|
|
+++ b/drivers/ssb/driver_chipcommon_pmu.c
|
|
@@ -110,8 +110,8 @@ static void ssb_pmu0_pllinit_r0(struct s
|
|
return;
|
|
}
|
|
|
|
- ssb_printk(KERN_INFO PFX "Programming PLL to %u.%03u MHz\n",
|
|
- (crystalfreq / 1000), (crystalfreq % 1000));
|
|
+ ssb_info("Programming PLL to %u.%03u MHz\n",
|
|
+ crystalfreq / 1000, crystalfreq % 1000);
|
|
|
|
/* First turn the PLL off. */
|
|
switch (bus->chip_id) {
|
|
@@ -138,7 +138,7 @@ static void ssb_pmu0_pllinit_r0(struct s
|
|
}
|
|
tmp = chipco_read32(cc, SSB_CHIPCO_CLKCTLST);
|
|
if (tmp & SSB_CHIPCO_CLKCTLST_HAVEHT)
|
|
- ssb_printk(KERN_EMERG PFX "Failed to turn the PLL off!\n");
|
|
+ ssb_emerg("Failed to turn the PLL off!\n");
|
|
|
|
/* Set PDIV in PLL control 0. */
|
|
pllctl = ssb_chipco_pll_read(cc, SSB_PMU0_PLLCTL0);
|
|
@@ -249,8 +249,8 @@ static void ssb_pmu1_pllinit_r0(struct s
|
|
return;
|
|
}
|
|
|
|
- ssb_printk(KERN_INFO PFX "Programming PLL to %u.%03u MHz\n",
|
|
- (crystalfreq / 1000), (crystalfreq % 1000));
|
|
+ ssb_info("Programming PLL to %u.%03u MHz\n",
|
|
+ crystalfreq / 1000, crystalfreq % 1000);
|
|
|
|
/* First turn the PLL off. */
|
|
switch (bus->chip_id) {
|
|
@@ -275,7 +275,7 @@ static void ssb_pmu1_pllinit_r0(struct s
|
|
}
|
|
tmp = chipco_read32(cc, SSB_CHIPCO_CLKCTLST);
|
|
if (tmp & SSB_CHIPCO_CLKCTLST_HAVEHT)
|
|
- ssb_printk(KERN_EMERG PFX "Failed to turn the PLL off!\n");
|
|
+ ssb_emerg("Failed to turn the PLL off!\n");
|
|
|
|
/* Set p1div and p2div. */
|
|
pllctl = ssb_chipco_pll_read(cc, SSB_PMU1_PLLCTL0);
|
|
@@ -349,9 +349,8 @@ static void ssb_pmu_pll_init(struct ssb_
|
|
case 43222:
|
|
break;
|
|
default:
|
|
- ssb_printk(KERN_ERR PFX
|
|
- "ERROR: PLL init unknown for device %04X\n",
|
|
- bus->chip_id);
|
|
+ ssb_err("ERROR: PLL init unknown for device %04X\n",
|
|
+ bus->chip_id);
|
|
}
|
|
}
|
|
|
|
@@ -472,9 +471,8 @@ static void ssb_pmu_resources_init(struc
|
|
max_msk = 0xFFFFF;
|
|
break;
|
|
default:
|
|
- ssb_printk(KERN_ERR PFX
|
|
- "ERROR: PMU resource config unknown for device %04X\n",
|
|
- bus->chip_id);
|
|
+ ssb_err("ERROR: PMU resource config unknown for device %04X\n",
|
|
+ bus->chip_id);
|
|
}
|
|
|
|
if (updown_tab) {
|
|
@@ -526,8 +524,8 @@ void ssb_pmu_init(struct ssb_chipcommon
|
|
pmucap = chipco_read32(cc, SSB_CHIPCO_PMU_CAP);
|
|
cc->pmu.rev = (pmucap & SSB_CHIPCO_PMU_CAP_REVISION);
|
|
|
|
- ssb_dprintk(KERN_DEBUG PFX "Found rev %u PMU (capabilities 0x%08X)\n",
|
|
- cc->pmu.rev, pmucap);
|
|
+ ssb_dbg("Found rev %u PMU (capabilities 0x%08X)\n",
|
|
+ cc->pmu.rev, pmucap);
|
|
|
|
if (cc->pmu.rev == 1)
|
|
chipco_mask32(cc, SSB_CHIPCO_PMU_CTL,
|
|
@@ -638,9 +636,8 @@ u32 ssb_pmu_get_alp_clock(struct ssb_chi
|
|
case 0x5354:
|
|
ssb_pmu_get_alp_clock_clk0(cc);
|
|
default:
|
|
- ssb_printk(KERN_ERR PFX
|
|
- "ERROR: PMU alp clock unknown for device %04X\n",
|
|
- bus->chip_id);
|
|
+ ssb_err("ERROR: PMU alp clock unknown for device %04X\n",
|
|
+ bus->chip_id);
|
|
return 0;
|
|
}
|
|
}
|
|
@@ -654,9 +651,8 @@ u32 ssb_pmu_get_cpu_clock(struct ssb_chi
|
|
/* 5354 chip uses a non programmable PLL of frequency 240MHz */
|
|
return 240000000;
|
|
default:
|
|
- ssb_printk(KERN_ERR PFX
|
|
- "ERROR: PMU cpu clock unknown for device %04X\n",
|
|
- bus->chip_id);
|
|
+ ssb_err("ERROR: PMU cpu clock unknown for device %04X\n",
|
|
+ bus->chip_id);
|
|
return 0;
|
|
}
|
|
}
|
|
@@ -669,9 +665,8 @@ u32 ssb_pmu_get_controlclock(struct ssb_
|
|
case 0x5354:
|
|
return 120000000;
|
|
default:
|
|
- ssb_printk(KERN_ERR PFX
|
|
- "ERROR: PMU controlclock unknown for device %04X\n",
|
|
- bus->chip_id);
|
|
+ ssb_err("ERROR: PMU controlclock unknown for device %04X\n",
|
|
+ bus->chip_id);
|
|
return 0;
|
|
}
|
|
}
|
|
@@ -692,8 +687,23 @@ void ssb_pmu_spuravoid_pllupdate(struct
|
|
pmu_ctl = SSB_CHIPCO_PMU_CTL_PLL_UPD;
|
|
break;
|
|
case 43222:
|
|
- /* TODO: BCM43222 requires updating PLLs too */
|
|
- return;
|
|
+ if (spuravoid == 1) {
|
|
+ ssb_chipco_pll_write(cc, SSB_PMU1_PLLCTL0, 0x11500008);
|
|
+ ssb_chipco_pll_write(cc, SSB_PMU1_PLLCTL1, 0x0C000C06);
|
|
+ ssb_chipco_pll_write(cc, SSB_PMU1_PLLCTL2, 0x0F600a08);
|
|
+ ssb_chipco_pll_write(cc, SSB_PMU1_PLLCTL3, 0x00000000);
|
|
+ ssb_chipco_pll_write(cc, SSB_PMU1_PLLCTL4, 0x2001E920);
|
|
+ ssb_chipco_pll_write(cc, SSB_PMU1_PLLCTL5, 0x88888815);
|
|
+ } else {
|
|
+ ssb_chipco_pll_write(cc, SSB_PMU1_PLLCTL0, 0x11100008);
|
|
+ ssb_chipco_pll_write(cc, SSB_PMU1_PLLCTL1, 0x0c000c06);
|
|
+ ssb_chipco_pll_write(cc, SSB_PMU1_PLLCTL2, 0x03000a08);
|
|
+ ssb_chipco_pll_write(cc, SSB_PMU1_PLLCTL3, 0x00000000);
|
|
+ ssb_chipco_pll_write(cc, SSB_PMU1_PLLCTL4, 0x200005c0);
|
|
+ ssb_chipco_pll_write(cc, SSB_PMU1_PLLCTL5, 0x88888855);
|
|
+ }
|
|
+ pmu_ctl = SSB_CHIPCO_PMU_CTL_PLL_UPD;
|
|
+ break;
|
|
default:
|
|
ssb_printk(KERN_ERR PFX
|
|
"Unknown spuravoidance settings for chip 0x%04X, not changing PLL\n",
|
|
--- a/drivers/ssb/driver_chipcommon_sflash.c
|
|
+++ b/drivers/ssb/driver_chipcommon_sflash.c
|
|
@@ -9,6 +9,19 @@
|
|
|
|
#include "ssb_private.h"
|
|
|
|
+static struct resource ssb_sflash_resource = {
|
|
+ .name = "ssb_sflash",
|
|
+ .start = SSB_FLASH2,
|
|
+ .end = 0,
|
|
+ .flags = IORESOURCE_MEM | IORESOURCE_READONLY,
|
|
+};
|
|
+
|
|
+struct platform_device ssb_sflash_dev = {
|
|
+ .name = "ssb_sflash",
|
|
+ .resource = &ssb_sflash_resource,
|
|
+ .num_resources = 1,
|
|
+};
|
|
+
|
|
struct ssb_sflash_tbl_e {
|
|
char *name;
|
|
u32 id;
|
|
@@ -16,7 +29,7 @@ struct ssb_sflash_tbl_e {
|
|
u16 numblocks;
|
|
};
|
|
|
|
-static struct ssb_sflash_tbl_e ssb_sflash_st_tbl[] = {
|
|
+static const struct ssb_sflash_tbl_e ssb_sflash_st_tbl[] = {
|
|
{ "M25P20", 0x11, 0x10000, 4, },
|
|
{ "M25P40", 0x12, 0x10000, 8, },
|
|
|
|
@@ -27,7 +40,7 @@ static struct ssb_sflash_tbl_e ssb_sflas
|
|
{ 0 },
|
|
};
|
|
|
|
-static struct ssb_sflash_tbl_e ssb_sflash_sst_tbl[] = {
|
|
+static const struct ssb_sflash_tbl_e ssb_sflash_sst_tbl[] = {
|
|
{ "SST25WF512", 1, 0x1000, 16, },
|
|
{ "SST25VF512", 0x48, 0x1000, 16, },
|
|
{ "SST25WF010", 2, 0x1000, 32, },
|
|
@@ -45,7 +58,7 @@ static struct ssb_sflash_tbl_e ssb_sflas
|
|
{ 0 },
|
|
};
|
|
|
|
-static struct ssb_sflash_tbl_e ssb_sflash_at_tbl[] = {
|
|
+static const struct ssb_sflash_tbl_e ssb_sflash_at_tbl[] = {
|
|
{ "AT45DB011", 0xc, 256, 512, },
|
|
{ "AT45DB021", 0x14, 256, 1024, },
|
|
{ "AT45DB041", 0x1c, 256, 2048, },
|
|
@@ -73,7 +86,8 @@ static void ssb_sflash_cmd(struct ssb_ch
|
|
/* Initialize serial flash access */
|
|
int ssb_sflash_init(struct ssb_chipcommon *cc)
|
|
{
|
|
- struct ssb_sflash_tbl_e *e;
|
|
+ struct ssb_sflash *sflash = &cc->dev->bus->mipscore.sflash;
|
|
+ const struct ssb_sflash_tbl_e *e;
|
|
u32 id, id2;
|
|
|
|
switch (cc->capabilities & SSB_CHIPCO_CAP_FLASHT) {
|
|
@@ -131,10 +145,20 @@ int ssb_sflash_init(struct ssb_chipcommo
|
|
return -ENOTSUPP;
|
|
}
|
|
|
|
- pr_info("Found %s serial flash (blocksize: 0x%X, blocks: %d)\n",
|
|
- e->name, e->blocksize, e->numblocks);
|
|
-
|
|
- pr_err("Serial flash support is not implemented yet!\n");
|
|
+ sflash->window = SSB_FLASH2;
|
|
+ sflash->blocksize = e->blocksize;
|
|
+ sflash->numblocks = e->numblocks;
|
|
+ sflash->size = sflash->blocksize * sflash->numblocks;
|
|
+ sflash->present = true;
|
|
+
|
|
+ pr_info("Found %s serial flash (size: %dKiB, blocksize: 0x%X, blocks: %d)\n",
|
|
+ e->name, sflash->size / 1024, e->blocksize, e->numblocks);
|
|
+
|
|
+ /* Prepare platform device, but don't register it yet. It's too early,
|
|
+ * malloc (required by device_private_init) is not available yet. */
|
|
+ ssb_sflash_dev.resource[0].end = ssb_sflash_dev.resource[0].start +
|
|
+ sflash->size;
|
|
+ ssb_sflash_dev.dev.platform_data = sflash;
|
|
|
|
- return -ENOTSUPP;
|
|
+ return 0;
|
|
}
|
|
--- a/drivers/ssb/driver_mipscore.c
|
|
+++ b/drivers/ssb/driver_mipscore.c
|
|
@@ -167,21 +167,22 @@ static void set_irq(struct ssb_device *d
|
|
irqflag |= (ipsflag & ~ipsflag_irq_mask[irq]);
|
|
ssb_write32(mdev, SSB_IPSFLAG, irqflag);
|
|
}
|
|
- ssb_dprintk(KERN_INFO PFX
|
|
- "set_irq: core 0x%04x, irq %d => %d\n",
|
|
- dev->id.coreid, oldirq+2, irq+2);
|
|
+ ssb_dbg("set_irq: core 0x%04x, irq %d => %d\n",
|
|
+ dev->id.coreid, oldirq+2, irq+2);
|
|
}
|
|
|
|
static void print_irq(struct ssb_device *dev, unsigned int irq)
|
|
{
|
|
- int i;
|
|
static const char *irq_name[] = {"2(S)", "3", "4", "5", "6", "D", "I"};
|
|
- ssb_dprintk(KERN_INFO PFX
|
|
- "core 0x%04x, irq :", dev->id.coreid);
|
|
- for (i = 0; i <= 6; i++) {
|
|
- ssb_dprintk(" %s%s", irq_name[i], i==irq?"*":" ");
|
|
- }
|
|
- ssb_dprintk("\n");
|
|
+ ssb_dbg("core 0x%04x, irq : %s%s %s%s %s%s %s%s %s%s %s%s %s%s\n",
|
|
+ dev->id.coreid,
|
|
+ irq_name[0], irq == 0 ? "*" : " ",
|
|
+ irq_name[1], irq == 1 ? "*" : " ",
|
|
+ irq_name[2], irq == 2 ? "*" : " ",
|
|
+ irq_name[3], irq == 3 ? "*" : " ",
|
|
+ irq_name[4], irq == 4 ? "*" : " ",
|
|
+ irq_name[5], irq == 5 ? "*" : " ",
|
|
+ irq_name[6], irq == 6 ? "*" : " ");
|
|
}
|
|
|
|
static void dump_irq(struct ssb_bus *bus)
|
|
@@ -286,7 +287,7 @@ void ssb_mipscore_init(struct ssb_mipsco
|
|
if (!mcore->dev)
|
|
return; /* We don't have a MIPS core */
|
|
|
|
- ssb_dprintk(KERN_INFO PFX "Initializing MIPS core...\n");
|
|
+ ssb_dbg("Initializing MIPS core...\n");
|
|
|
|
bus = mcore->dev->bus;
|
|
hz = ssb_clockspeed(bus);
|
|
@@ -334,7 +335,7 @@ void ssb_mipscore_init(struct ssb_mipsco
|
|
break;
|
|
}
|
|
}
|
|
- ssb_dprintk(KERN_INFO PFX "after irq reconfiguration\n");
|
|
+ ssb_dbg("after irq reconfiguration\n");
|
|
dump_irq(bus);
|
|
|
|
ssb_mips_serial_init(mcore);
|
|
--- a/drivers/ssb/driver_pcicore.c
|
|
+++ b/drivers/ssb/driver_pcicore.c
|
|
@@ -263,8 +263,7 @@ int ssb_pcicore_plat_dev_init(struct pci
|
|
return -ENODEV;
|
|
}
|
|
|
|
- ssb_printk(KERN_INFO "PCI: Fixing up device %s\n",
|
|
- pci_name(d));
|
|
+ ssb_info("PCI: Fixing up device %s\n", pci_name(d));
|
|
|
|
/* Fix up interrupt lines */
|
|
d->irq = ssb_mips_irq(extpci_core->dev) + 2;
|
|
@@ -285,12 +284,12 @@ static void ssb_pcicore_fixup_pcibridge(
|
|
if (dev->bus->number != 0 || PCI_SLOT(dev->devfn) != 0)
|
|
return;
|
|
|
|
- ssb_printk(KERN_INFO "PCI: Fixing up bridge %s\n", pci_name(dev));
|
|
+ ssb_info("PCI: Fixing up bridge %s\n", pci_name(dev));
|
|
|
|
/* Enable PCI bridge bus mastering and memory space */
|
|
pci_set_master(dev);
|
|
if (pcibios_enable_device(dev, ~0) < 0) {
|
|
- ssb_printk(KERN_ERR "PCI: SSB bridge enable failed\n");
|
|
+ ssb_err("PCI: SSB bridge enable failed\n");
|
|
return;
|
|
}
|
|
|
|
@@ -299,8 +298,8 @@ static void ssb_pcicore_fixup_pcibridge(
|
|
|
|
/* Make sure our latency is high enough to handle the devices behind us */
|
|
lat = 168;
|
|
- ssb_printk(KERN_INFO "PCI: Fixing latency timer of device %s to %u\n",
|
|
- pci_name(dev), lat);
|
|
+ ssb_info("PCI: Fixing latency timer of device %s to %u\n",
|
|
+ pci_name(dev), lat);
|
|
pci_write_config_byte(dev, PCI_LATENCY_TIMER, lat);
|
|
}
|
|
DECLARE_PCI_FIXUP_EARLY(PCI_ANY_ID, PCI_ANY_ID, ssb_pcicore_fixup_pcibridge);
|
|
@@ -323,7 +322,7 @@ static void ssb_pcicore_init_hostmode(st
|
|
return;
|
|
extpci_core = pc;
|
|
|
|
- ssb_dprintk(KERN_INFO PFX "PCIcore in host mode found\n");
|
|
+ ssb_dbg("PCIcore in host mode found\n");
|
|
/* Reset devices on the external PCI bus */
|
|
val = SSB_PCICORE_CTL_RST_OE;
|
|
val |= SSB_PCICORE_CTL_CLK_OE;
|
|
@@ -338,7 +337,7 @@ static void ssb_pcicore_init_hostmode(st
|
|
udelay(1); /* Assertion time demanded by the PCI standard */
|
|
|
|
if (pc->dev->bus->has_cardbus_slot) {
|
|
- ssb_dprintk(KERN_INFO PFX "CardBus slot detected\n");
|
|
+ ssb_dbg("CardBus slot detected\n");
|
|
pc->cardbusmode = 1;
|
|
/* GPIO 1 resets the bridge */
|
|
ssb_gpio_out(pc->dev->bus, 1, 1);
|
|
--- a/drivers/ssb/embedded.c
|
|
+++ b/drivers/ssb/embedded.c
|
|
@@ -57,9 +57,8 @@ int ssb_watchdog_register(struct ssb_bus
|
|
bus->busnumber, &wdt,
|
|
sizeof(wdt));
|
|
if (IS_ERR(pdev)) {
|
|
- ssb_dprintk(KERN_INFO PFX
|
|
- "can not register watchdog device, err: %li\n",
|
|
- PTR_ERR(pdev));
|
|
+ ssb_dbg("can not register watchdog device, err: %li\n",
|
|
+ PTR_ERR(pdev));
|
|
return PTR_ERR(pdev);
|
|
}
|
|
|
|
--- a/drivers/ssb/main.c
|
|
+++ b/drivers/ssb/main.c
|
|
@@ -275,8 +275,8 @@ int ssb_devices_thaw(struct ssb_freeze_c
|
|
|
|
err = sdrv->probe(sdev, &sdev->id);
|
|
if (err) {
|
|
- ssb_printk(KERN_ERR PFX "Failed to thaw device %s\n",
|
|
- dev_name(sdev->dev));
|
|
+ ssb_err("Failed to thaw device %s\n",
|
|
+ dev_name(sdev->dev));
|
|
result = err;
|
|
}
|
|
ssb_device_put(sdev);
|
|
@@ -447,10 +447,9 @@ void ssb_bus_unregister(struct ssb_bus *
|
|
|
|
err = ssb_gpio_unregister(bus);
|
|
if (err == -EBUSY)
|
|
- ssb_dprintk(KERN_ERR PFX "Some GPIOs are still in use.\n");
|
|
+ ssb_dbg("Some GPIOs are still in use\n");
|
|
else if (err)
|
|
- ssb_dprintk(KERN_ERR PFX
|
|
- "Can not unregister GPIO driver: %i\n", err);
|
|
+ ssb_dbg("Can not unregister GPIO driver: %i\n", err);
|
|
|
|
ssb_buses_lock();
|
|
ssb_devices_unregister(bus);
|
|
@@ -497,8 +496,7 @@ static int ssb_devices_register(struct s
|
|
|
|
devwrap = kzalloc(sizeof(*devwrap), GFP_KERNEL);
|
|
if (!devwrap) {
|
|
- ssb_printk(KERN_ERR PFX
|
|
- "Could not allocate device\n");
|
|
+ ssb_err("Could not allocate device\n");
|
|
err = -ENOMEM;
|
|
goto error;
|
|
}
|
|
@@ -537,9 +535,7 @@ static int ssb_devices_register(struct s
|
|
sdev->dev = dev;
|
|
err = device_register(dev);
|
|
if (err) {
|
|
- ssb_printk(KERN_ERR PFX
|
|
- "Could not register %s\n",
|
|
- dev_name(dev));
|
|
+ ssb_err("Could not register %s\n", dev_name(dev));
|
|
/* Set dev to NULL to not unregister
|
|
* dev on error unwinding. */
|
|
sdev->dev = NULL;
|
|
@@ -557,6 +553,14 @@ static int ssb_devices_register(struct s
|
|
}
|
|
#endif
|
|
|
|
+#ifdef CONFIG_SSB_SFLASH
|
|
+ if (bus->mipscore.sflash.present) {
|
|
+ err = platform_device_register(&ssb_sflash_dev);
|
|
+ if (err)
|
|
+ pr_err("Error registering serial flash\n");
|
|
+ }
|
|
+#endif
|
|
+
|
|
return 0;
|
|
error:
|
|
/* Unwind the already registered devices. */
|
|
@@ -825,10 +829,9 @@ static int ssb_bus_register(struct ssb_b
|
|
ssb_mipscore_init(&bus->mipscore);
|
|
err = ssb_gpio_init(bus);
|
|
if (err == -ENOTSUPP)
|
|
- ssb_dprintk(KERN_DEBUG PFX "GPIO driver not activated\n");
|
|
+ ssb_dbg("GPIO driver not activated\n");
|
|
else if (err)
|
|
- ssb_dprintk(KERN_ERR PFX
|
|
- "Error registering GPIO driver: %i\n", err);
|
|
+ ssb_dbg("Error registering GPIO driver: %i\n", err);
|
|
err = ssb_fetch_invariants(bus, get_invariants);
|
|
if (err) {
|
|
ssb_bus_may_powerdown(bus);
|
|
@@ -878,11 +881,11 @@ int ssb_bus_pcibus_register(struct ssb_b
|
|
|
|
err = ssb_bus_register(bus, ssb_pci_get_invariants, 0);
|
|
if (!err) {
|
|
- ssb_printk(KERN_INFO PFX "Sonics Silicon Backplane found on "
|
|
- "PCI device %s\n", dev_name(&host_pci->dev));
|
|
+ ssb_info("Sonics Silicon Backplane found on PCI device %s\n",
|
|
+ dev_name(&host_pci->dev));
|
|
} else {
|
|
- ssb_printk(KERN_ERR PFX "Failed to register PCI version"
|
|
- " of SSB with error %d\n", err);
|
|
+ ssb_err("Failed to register PCI version of SSB with error %d\n",
|
|
+ err);
|
|
}
|
|
|
|
return err;
|
|
@@ -903,8 +906,8 @@ int ssb_bus_pcmciabus_register(struct ss
|
|
|
|
err = ssb_bus_register(bus, ssb_pcmcia_get_invariants, baseaddr);
|
|
if (!err) {
|
|
- ssb_printk(KERN_INFO PFX "Sonics Silicon Backplane found on "
|
|
- "PCMCIA device %s\n", pcmcia_dev->devname);
|
|
+ ssb_info("Sonics Silicon Backplane found on PCMCIA device %s\n",
|
|
+ pcmcia_dev->devname);
|
|
}
|
|
|
|
return err;
|
|
@@ -925,8 +928,8 @@ int ssb_bus_sdiobus_register(struct ssb_
|
|
|
|
err = ssb_bus_register(bus, ssb_sdio_get_invariants, ~0);
|
|
if (!err) {
|
|
- ssb_printk(KERN_INFO PFX "Sonics Silicon Backplane found on "
|
|
- "SDIO device %s\n", sdio_func_id(func));
|
|
+ ssb_info("Sonics Silicon Backplane found on SDIO device %s\n",
|
|
+ sdio_func_id(func));
|
|
}
|
|
|
|
return err;
|
|
@@ -944,8 +947,8 @@ int ssb_bus_ssbbus_register(struct ssb_b
|
|
|
|
err = ssb_bus_register(bus, get_invariants, baseaddr);
|
|
if (!err) {
|
|
- ssb_printk(KERN_INFO PFX "Sonics Silicon Backplane found at "
|
|
- "address 0x%08lX\n", baseaddr);
|
|
+ ssb_info("Sonics Silicon Backplane found at address 0x%08lX\n",
|
|
+ baseaddr);
|
|
}
|
|
|
|
return err;
|
|
@@ -1339,7 +1342,7 @@ out:
|
|
#endif
|
|
return err;
|
|
error:
|
|
- ssb_printk(KERN_ERR PFX "Bus powerdown failed\n");
|
|
+ ssb_err("Bus powerdown failed\n");
|
|
goto out;
|
|
}
|
|
EXPORT_SYMBOL(ssb_bus_may_powerdown);
|
|
@@ -1362,7 +1365,7 @@ int ssb_bus_powerup(struct ssb_bus *bus,
|
|
|
|
return 0;
|
|
error:
|
|
- ssb_printk(KERN_ERR PFX "Bus powerup failed\n");
|
|
+ ssb_err("Bus powerup failed\n");
|
|
return err;
|
|
}
|
|
EXPORT_SYMBOL(ssb_bus_powerup);
|
|
@@ -1470,15 +1473,13 @@ static int __init ssb_modinit(void)
|
|
|
|
err = b43_pci_ssb_bridge_init();
|
|
if (err) {
|
|
- ssb_printk(KERN_ERR "Broadcom 43xx PCI-SSB-bridge "
|
|
- "initialization failed\n");
|
|
+ ssb_err("Broadcom 43xx PCI-SSB-bridge initialization failed\n");
|
|
/* don't fail SSB init because of this */
|
|
err = 0;
|
|
}
|
|
err = ssb_gige_init();
|
|
if (err) {
|
|
- ssb_printk(KERN_ERR "SSB Broadcom Gigabit Ethernet "
|
|
- "driver initialization failed\n");
|
|
+ ssb_err("SSB Broadcom Gigabit Ethernet driver initialization failed\n");
|
|
/* don't fail SSB init because of this */
|
|
err = 0;
|
|
}
|
|
--- a/drivers/ssb/pci.c
|
|
+++ b/drivers/ssb/pci.c
|
|
@@ -56,7 +56,7 @@ int ssb_pci_switch_coreidx(struct ssb_bu
|
|
}
|
|
return 0;
|
|
error:
|
|
- ssb_printk(KERN_ERR PFX "Failed to switch to core %u\n", coreidx);
|
|
+ ssb_err("Failed to switch to core %u\n", coreidx);
|
|
return -ENODEV;
|
|
}
|
|
|
|
@@ -67,10 +67,9 @@ int ssb_pci_switch_core(struct ssb_bus *
|
|
unsigned long flags;
|
|
|
|
#if SSB_VERBOSE_PCICORESWITCH_DEBUG
|
|
- ssb_printk(KERN_INFO PFX
|
|
- "Switching to %s core, index %d\n",
|
|
- ssb_core_name(dev->id.coreid),
|
|
- dev->core_index);
|
|
+ ssb_info("Switching to %s core, index %d\n",
|
|
+ ssb_core_name(dev->id.coreid),
|
|
+ dev->core_index);
|
|
#endif
|
|
|
|
spin_lock_irqsave(&bus->bar_lock, flags);
|
|
@@ -231,6 +230,15 @@ static inline u8 ssb_crc8(u8 crc, u8 dat
|
|
return t[crc ^ data];
|
|
}
|
|
|
|
+static void sprom_get_mac(char *mac, const u16 *in)
|
|
+{
|
|
+ int i;
|
|
+ for (i = 0; i < 3; i++) {
|
|
+ *mac++ = in[i] >> 8;
|
|
+ *mac++ = in[i];
|
|
+ }
|
|
+}
|
|
+
|
|
static u8 ssb_sprom_crc(const u16 *sprom, u16 size)
|
|
{
|
|
int word;
|
|
@@ -278,7 +286,7 @@ static int sprom_do_write(struct ssb_bus
|
|
u32 spromctl;
|
|
u16 size = bus->sprom_size;
|
|
|
|
- ssb_printk(KERN_NOTICE PFX "Writing SPROM. Do NOT turn off the power! Please stand by...\n");
|
|
+ ssb_notice("Writing SPROM. Do NOT turn off the power! Please stand by...\n");
|
|
err = pci_read_config_dword(pdev, SSB_SPROMCTL, &spromctl);
|
|
if (err)
|
|
goto err_ctlreg;
|
|
@@ -286,17 +294,17 @@ static int sprom_do_write(struct ssb_bus
|
|
err = pci_write_config_dword(pdev, SSB_SPROMCTL, spromctl);
|
|
if (err)
|
|
goto err_ctlreg;
|
|
- ssb_printk(KERN_NOTICE PFX "[ 0%%");
|
|
+ ssb_notice("[ 0%%");
|
|
msleep(500);
|
|
for (i = 0; i < size; i++) {
|
|
if (i == size / 4)
|
|
- ssb_printk("25%%");
|
|
+ ssb_cont("25%%");
|
|
else if (i == size / 2)
|
|
- ssb_printk("50%%");
|
|
+ ssb_cont("50%%");
|
|
else if (i == (size * 3) / 4)
|
|
- ssb_printk("75%%");
|
|
+ ssb_cont("75%%");
|
|
else if (i % 2)
|
|
- ssb_printk(".");
|
|
+ ssb_cont(".");
|
|
writew(sprom[i], bus->mmio + bus->sprom_offset + (i * 2));
|
|
mmiowb();
|
|
msleep(20);
|
|
@@ -309,12 +317,12 @@ static int sprom_do_write(struct ssb_bus
|
|
if (err)
|
|
goto err_ctlreg;
|
|
msleep(500);
|
|
- ssb_printk("100%% ]\n");
|
|
- ssb_printk(KERN_NOTICE PFX "SPROM written.\n");
|
|
+ ssb_cont("100%% ]\n");
|
|
+ ssb_notice("SPROM written\n");
|
|
|
|
return 0;
|
|
err_ctlreg:
|
|
- ssb_printk(KERN_ERR PFX "Could not access SPROM control register.\n");
|
|
+ ssb_err("Could not access SPROM control register.\n");
|
|
return err;
|
|
}
|
|
|
|
@@ -339,10 +347,23 @@ static s8 r123_extract_antgain(u8 sprom_
|
|
return (s8)gain;
|
|
}
|
|
|
|
+static void sprom_extract_r23(struct ssb_sprom *out, const u16 *in)
|
|
+{
|
|
+ SPEX(boardflags_hi, SSB_SPROM2_BFLHI, 0xFFFF, 0);
|
|
+ SPEX(opo, SSB_SPROM2_OPO, SSB_SPROM2_OPO_VALUE, 0);
|
|
+ SPEX(pa1lob0, SSB_SPROM2_PA1LOB0, 0xFFFF, 0);
|
|
+ SPEX(pa1lob1, SSB_SPROM2_PA1LOB1, 0xFFFF, 0);
|
|
+ SPEX(pa1lob2, SSB_SPROM2_PA1LOB2, 0xFFFF, 0);
|
|
+ SPEX(pa1hib0, SSB_SPROM2_PA1HIB0, 0xFFFF, 0);
|
|
+ SPEX(pa1hib1, SSB_SPROM2_PA1HIB1, 0xFFFF, 0);
|
|
+ SPEX(pa1hib2, SSB_SPROM2_PA1HIB2, 0xFFFF, 0);
|
|
+ SPEX(maxpwr_ah, SSB_SPROM2_MAXP_A, SSB_SPROM2_MAXP_A_HI, 0);
|
|
+ SPEX(maxpwr_al, SSB_SPROM2_MAXP_A, SSB_SPROM2_MAXP_A_LO,
|
|
+ SSB_SPROM2_MAXP_A_LO_SHIFT);
|
|
+}
|
|
+
|
|
static void sprom_extract_r123(struct ssb_sprom *out, const u16 *in)
|
|
{
|
|
- int i;
|
|
- u16 v;
|
|
u16 loc[3];
|
|
|
|
if (out->revision == 3) /* rev 3 moved MAC */
|
|
@@ -352,19 +373,10 @@ static void sprom_extract_r123(struct ss
|
|
loc[1] = SSB_SPROM1_ET0MAC;
|
|
loc[2] = SSB_SPROM1_ET1MAC;
|
|
}
|
|
- for (i = 0; i < 3; i++) {
|
|
- v = in[SPOFF(loc[0]) + i];
|
|
- *(((__be16 *)out->il0mac) + i) = cpu_to_be16(v);
|
|
- }
|
|
+ sprom_get_mac(out->il0mac, &in[SPOFF(loc[0])]);
|
|
if (out->revision < 3) { /* only rev 1-2 have et0, et1 */
|
|
- for (i = 0; i < 3; i++) {
|
|
- v = in[SPOFF(loc[1]) + i];
|
|
- *(((__be16 *)out->et0mac) + i) = cpu_to_be16(v);
|
|
- }
|
|
- for (i = 0; i < 3; i++) {
|
|
- v = in[SPOFF(loc[2]) + i];
|
|
- *(((__be16 *)out->et1mac) + i) = cpu_to_be16(v);
|
|
- }
|
|
+ sprom_get_mac(out->et0mac, &in[SPOFF(loc[1])]);
|
|
+ sprom_get_mac(out->et1mac, &in[SPOFF(loc[2])]);
|
|
}
|
|
SPEX(et0phyaddr, SSB_SPROM1_ETHPHY, SSB_SPROM1_ETHPHY_ET0A, 0);
|
|
SPEX(et1phyaddr, SSB_SPROM1_ETHPHY, SSB_SPROM1_ETHPHY_ET1A,
|
|
@@ -372,6 +384,7 @@ static void sprom_extract_r123(struct ss
|
|
SPEX(et0mdcport, SSB_SPROM1_ETHPHY, SSB_SPROM1_ETHPHY_ET0M, 14);
|
|
SPEX(et1mdcport, SSB_SPROM1_ETHPHY, SSB_SPROM1_ETHPHY_ET1M, 15);
|
|
SPEX(board_rev, SSB_SPROM1_BINF, SSB_SPROM1_BINF_BREV, 0);
|
|
+ SPEX(board_type, SSB_SPROM1_SPID, 0xFFFF, 0);
|
|
if (out->revision == 1)
|
|
SPEX(country_code, SSB_SPROM1_BINF, SSB_SPROM1_BINF_CCODE,
|
|
SSB_SPROM1_BINF_CCODE_SHIFT);
|
|
@@ -398,8 +411,7 @@ static void sprom_extract_r123(struct ss
|
|
SSB_SPROM1_ITSSI_A_SHIFT);
|
|
SPEX(itssi_bg, SSB_SPROM1_ITSSI, SSB_SPROM1_ITSSI_BG, 0);
|
|
SPEX(boardflags_lo, SSB_SPROM1_BFLLO, 0xFFFF, 0);
|
|
- if (out->revision >= 2)
|
|
- SPEX(boardflags_hi, SSB_SPROM2_BFLHI, 0xFFFF, 0);
|
|
+
|
|
SPEX(alpha2[0], SSB_SPROM1_CCODE, 0xff00, 8);
|
|
SPEX(alpha2[1], SSB_SPROM1_CCODE, 0x00ff, 0);
|
|
|
|
@@ -410,6 +422,8 @@ static void sprom_extract_r123(struct ss
|
|
out->antenna_gain.a1 = r123_extract_antgain(out->revision, in,
|
|
SSB_SPROM1_AGAIN_A,
|
|
SSB_SPROM1_AGAIN_A_SHIFT);
|
|
+ if (out->revision >= 2)
|
|
+ sprom_extract_r23(out, in);
|
|
}
|
|
|
|
/* Revs 4 5 and 8 have partially shared layout */
|
|
@@ -454,23 +468,20 @@ static void sprom_extract_r458(struct ss
|
|
|
|
static void sprom_extract_r45(struct ssb_sprom *out, const u16 *in)
|
|
{
|
|
- int i;
|
|
- u16 v;
|
|
u16 il0mac_offset;
|
|
|
|
if (out->revision == 4)
|
|
il0mac_offset = SSB_SPROM4_IL0MAC;
|
|
else
|
|
il0mac_offset = SSB_SPROM5_IL0MAC;
|
|
- /* extract the MAC address */
|
|
- for (i = 0; i < 3; i++) {
|
|
- v = in[SPOFF(il0mac_offset) + i];
|
|
- *(((__be16 *)out->il0mac) + i) = cpu_to_be16(v);
|
|
- }
|
|
+
|
|
+ sprom_get_mac(out->il0mac, &in[SPOFF(il0mac_offset)]);
|
|
+
|
|
SPEX(et0phyaddr, SSB_SPROM4_ETHPHY, SSB_SPROM4_ETHPHY_ET0A, 0);
|
|
SPEX(et1phyaddr, SSB_SPROM4_ETHPHY, SSB_SPROM4_ETHPHY_ET1A,
|
|
SSB_SPROM4_ETHPHY_ET1A_SHIFT);
|
|
SPEX(board_rev, SSB_SPROM4_BOARDREV, 0xFFFF, 0);
|
|
+ SPEX(board_type, SSB_SPROM1_SPID, 0xFFFF, 0);
|
|
if (out->revision == 4) {
|
|
SPEX(alpha2[0], SSB_SPROM4_CCODE, 0xff00, 8);
|
|
SPEX(alpha2[1], SSB_SPROM4_CCODE, 0x00ff, 0);
|
|
@@ -530,7 +541,7 @@ static void sprom_extract_r45(struct ssb
|
|
static void sprom_extract_r8(struct ssb_sprom *out, const u16 *in)
|
|
{
|
|
int i;
|
|
- u16 v, o;
|
|
+ u16 o;
|
|
u16 pwr_info_offset[] = {
|
|
SSB_SROM8_PWR_INFO_CORE0, SSB_SROM8_PWR_INFO_CORE1,
|
|
SSB_SROM8_PWR_INFO_CORE2, SSB_SROM8_PWR_INFO_CORE3
|
|
@@ -539,11 +550,10 @@ static void sprom_extract_r8(struct ssb_
|
|
ARRAY_SIZE(out->core_pwr_info));
|
|
|
|
/* extract the MAC address */
|
|
- for (i = 0; i < 3; i++) {
|
|
- v = in[SPOFF(SSB_SPROM8_IL0MAC) + i];
|
|
- *(((__be16 *)out->il0mac) + i) = cpu_to_be16(v);
|
|
- }
|
|
+ sprom_get_mac(out->il0mac, &in[SPOFF(SSB_SPROM8_IL0MAC)]);
|
|
+
|
|
SPEX(board_rev, SSB_SPROM8_BOARDREV, 0xFFFF, 0);
|
|
+ SPEX(board_type, SSB_SPROM1_SPID, 0xFFFF, 0);
|
|
SPEX(alpha2[0], SSB_SPROM8_CCODE, 0xff00, 8);
|
|
SPEX(alpha2[1], SSB_SPROM8_CCODE, 0x00ff, 0);
|
|
SPEX(boardflags_lo, SSB_SPROM8_BFLLO, 0xFFFF, 0);
|
|
@@ -743,7 +753,7 @@ static int sprom_extract(struct ssb_bus
|
|
memset(out, 0, sizeof(*out));
|
|
|
|
out->revision = in[size - 1] & 0x00FF;
|
|
- ssb_dprintk(KERN_DEBUG PFX "SPROM revision %d detected.\n", out->revision);
|
|
+ ssb_dbg("SPROM revision %d detected\n", out->revision);
|
|
memset(out->et0mac, 0xFF, 6); /* preset et0 and et1 mac */
|
|
memset(out->et1mac, 0xFF, 6);
|
|
|
|
@@ -752,7 +762,7 @@ static int sprom_extract(struct ssb_bus
|
|
* number stored in the SPROM.
|
|
* Always extract r1. */
|
|
out->revision = 1;
|
|
- ssb_dprintk(KERN_DEBUG PFX "SPROM treated as revision %d\n", out->revision);
|
|
+ ssb_dbg("SPROM treated as revision %d\n", out->revision);
|
|
}
|
|
|
|
switch (out->revision) {
|
|
@@ -769,9 +779,8 @@ static int sprom_extract(struct ssb_bus
|
|
sprom_extract_r8(out, in);
|
|
break;
|
|
default:
|
|
- ssb_printk(KERN_WARNING PFX "Unsupported SPROM"
|
|
- " revision %d detected. Will extract"
|
|
- " v1\n", out->revision);
|
|
+ ssb_warn("Unsupported SPROM revision %d detected. Will extract v1\n",
|
|
+ out->revision);
|
|
out->revision = 1;
|
|
sprom_extract_r123(out, in);
|
|
}
|
|
@@ -791,7 +800,7 @@ static int ssb_pci_sprom_get(struct ssb_
|
|
u16 *buf;
|
|
|
|
if (!ssb_is_sprom_available(bus)) {
|
|
- ssb_printk(KERN_ERR PFX "No SPROM available!\n");
|
|
+ ssb_err("No SPROM available!\n");
|
|
return -ENODEV;
|
|
}
|
|
if (bus->chipco.dev) { /* can be unavailable! */
|
|
@@ -810,7 +819,7 @@ static int ssb_pci_sprom_get(struct ssb_
|
|
} else {
|
|
bus->sprom_offset = SSB_SPROM_BASE1;
|
|
}
|
|
- ssb_dprintk(KERN_INFO PFX "SPROM offset is 0x%x\n", bus->sprom_offset);
|
|
+ ssb_dbg("SPROM offset is 0x%x\n", bus->sprom_offset);
|
|
|
|
buf = kcalloc(SSB_SPROMSIZE_WORDS_R123, sizeof(u16), GFP_KERNEL);
|
|
if (!buf)
|
|
@@ -835,18 +844,15 @@ static int ssb_pci_sprom_get(struct ssb_
|
|
* available for this device in some other storage */
|
|
err = ssb_fill_sprom_with_fallback(bus, sprom);
|
|
if (err) {
|
|
- ssb_printk(KERN_WARNING PFX "WARNING: Using"
|
|
- " fallback SPROM failed (err %d)\n",
|
|
- err);
|
|
+ ssb_warn("WARNING: Using fallback SPROM failed (err %d)\n",
|
|
+ err);
|
|
} else {
|
|
- ssb_dprintk(KERN_DEBUG PFX "Using SPROM"
|
|
- " revision %d provided by"
|
|
- " platform.\n", sprom->revision);
|
|
+ ssb_dbg("Using SPROM revision %d provided by platform\n",
|
|
+ sprom->revision);
|
|
err = 0;
|
|
goto out_free;
|
|
}
|
|
- ssb_printk(KERN_WARNING PFX "WARNING: Invalid"
|
|
- " SPROM CRC (corrupt SPROM)\n");
|
|
+ ssb_warn("WARNING: Invalid SPROM CRC (corrupt SPROM)\n");
|
|
}
|
|
}
|
|
err = sprom_extract(bus, sprom, buf, bus->sprom_size);
|
|
--- a/drivers/ssb/pcihost_wrapper.c
|
|
+++ b/drivers/ssb/pcihost_wrapper.c
|
|
@@ -38,7 +38,7 @@ static int ssb_pcihost_resume(struct pci
|
|
struct ssb_bus *ssb = pci_get_drvdata(dev);
|
|
int err;
|
|
|
|
- pci_set_power_state(dev, 0);
|
|
+ pci_set_power_state(dev, PCI_D0);
|
|
err = pci_enable_device(dev);
|
|
if (err)
|
|
return err;
|
|
--- a/drivers/ssb/pcmcia.c
|
|
+++ b/drivers/ssb/pcmcia.c
|
|
@@ -143,7 +143,7 @@ int ssb_pcmcia_switch_coreidx(struct ssb
|
|
|
|
return 0;
|
|
error:
|
|
- ssb_printk(KERN_ERR PFX "Failed to switch to core %u\n", coreidx);
|
|
+ ssb_err("Failed to switch to core %u\n", coreidx);
|
|
return err;
|
|
}
|
|
|
|
@@ -153,10 +153,9 @@ int ssb_pcmcia_switch_core(struct ssb_bu
|
|
int err;
|
|
|
|
#if SSB_VERBOSE_PCMCIACORESWITCH_DEBUG
|
|
- ssb_printk(KERN_INFO PFX
|
|
- "Switching to %s core, index %d\n",
|
|
- ssb_core_name(dev->id.coreid),
|
|
- dev->core_index);
|
|
+ ssb_info("Switching to %s core, index %d\n",
|
|
+ ssb_core_name(dev->id.coreid),
|
|
+ dev->core_index);
|
|
#endif
|
|
|
|
err = ssb_pcmcia_switch_coreidx(bus, dev->core_index);
|
|
@@ -192,7 +191,7 @@ int ssb_pcmcia_switch_segment(struct ssb
|
|
|
|
return 0;
|
|
error:
|
|
- ssb_printk(KERN_ERR PFX "Failed to switch pcmcia segment\n");
|
|
+ ssb_err("Failed to switch pcmcia segment\n");
|
|
return err;
|
|
}
|
|
|
|
@@ -549,44 +548,39 @@ static int ssb_pcmcia_sprom_write_all(st
|
|
bool failed = 0;
|
|
size_t size = SSB_PCMCIA_SPROM_SIZE;
|
|
|
|
- ssb_printk(KERN_NOTICE PFX
|
|
- "Writing SPROM. Do NOT turn off the power! "
|
|
- "Please stand by...\n");
|
|
+ ssb_notice("Writing SPROM. Do NOT turn off the power! Please stand by...\n");
|
|
err = ssb_pcmcia_sprom_command(bus, SSB_PCMCIA_SPROMCTL_WRITEEN);
|
|
if (err) {
|
|
- ssb_printk(KERN_NOTICE PFX
|
|
- "Could not enable SPROM write access.\n");
|
|
+ ssb_notice("Could not enable SPROM write access\n");
|
|
return -EBUSY;
|
|
}
|
|
- ssb_printk(KERN_NOTICE PFX "[ 0%%");
|
|
+ ssb_notice("[ 0%%");
|
|
msleep(500);
|
|
for (i = 0; i < size; i++) {
|
|
if (i == size / 4)
|
|
- ssb_printk("25%%");
|
|
+ ssb_cont("25%%");
|
|
else if (i == size / 2)
|
|
- ssb_printk("50%%");
|
|
+ ssb_cont("50%%");
|
|
else if (i == (size * 3) / 4)
|
|
- ssb_printk("75%%");
|
|
+ ssb_cont("75%%");
|
|
else if (i % 2)
|
|
- ssb_printk(".");
|
|
+ ssb_cont(".");
|
|
err = ssb_pcmcia_sprom_write(bus, i, sprom[i]);
|
|
if (err) {
|
|
- ssb_printk(KERN_NOTICE PFX
|
|
- "Failed to write to SPROM.\n");
|
|
+ ssb_notice("Failed to write to SPROM\n");
|
|
failed = 1;
|
|
break;
|
|
}
|
|
}
|
|
err = ssb_pcmcia_sprom_command(bus, SSB_PCMCIA_SPROMCTL_WRITEDIS);
|
|
if (err) {
|
|
- ssb_printk(KERN_NOTICE PFX
|
|
- "Could not disable SPROM write access.\n");
|
|
+ ssb_notice("Could not disable SPROM write access\n");
|
|
failed = 1;
|
|
}
|
|
msleep(500);
|
|
if (!failed) {
|
|
- ssb_printk("100%% ]\n");
|
|
- ssb_printk(KERN_NOTICE PFX "SPROM written.\n");
|
|
+ ssb_cont("100%% ]\n");
|
|
+ ssb_notice("SPROM written\n");
|
|
}
|
|
|
|
return failed ? -EBUSY : 0;
|
|
@@ -700,7 +694,7 @@ static int ssb_pcmcia_do_get_invariants(
|
|
return -ENOSPC; /* continue with next entry */
|
|
|
|
error:
|
|
- ssb_printk(KERN_ERR PFX
|
|
+ ssb_err(
|
|
"PCMCIA: Failed to fetch device invariants: %s\n",
|
|
error_description);
|
|
return -ENODEV;
|
|
@@ -722,7 +716,7 @@ int ssb_pcmcia_get_invariants(struct ssb
|
|
res = pcmcia_loop_tuple(bus->host_pcmcia, CISTPL_FUNCE,
|
|
ssb_pcmcia_get_mac, sprom);
|
|
if (res != 0) {
|
|
- ssb_printk(KERN_ERR PFX
|
|
+ ssb_err(
|
|
"PCMCIA: Failed to fetch MAC address\n");
|
|
return -ENODEV;
|
|
}
|
|
@@ -733,7 +727,7 @@ int ssb_pcmcia_get_invariants(struct ssb
|
|
if ((res == 0) || (res == -ENOSPC))
|
|
return 0;
|
|
|
|
- ssb_printk(KERN_ERR PFX
|
|
+ ssb_err(
|
|
"PCMCIA: Failed to fetch device invariants\n");
|
|
return -ENODEV;
|
|
}
|
|
@@ -843,6 +837,6 @@ int ssb_pcmcia_init(struct ssb_bus *bus)
|
|
|
|
return 0;
|
|
error:
|
|
- ssb_printk(KERN_ERR PFX "Failed to initialize PCMCIA host device\n");
|
|
+ ssb_err("Failed to initialize PCMCIA host device\n");
|
|
return err;
|
|
}
|
|
--- a/drivers/ssb/scan.c
|
|
+++ b/drivers/ssb/scan.c
|
|
@@ -125,8 +125,7 @@ static u16 pcidev_to_chipid(struct pci_d
|
|
chipid_fallback = 0x4401;
|
|
break;
|
|
default:
|
|
- ssb_printk(KERN_ERR PFX
|
|
- "PCI-ID not in fallback list\n");
|
|
+ ssb_err("PCI-ID not in fallback list\n");
|
|
}
|
|
|
|
return chipid_fallback;
|
|
@@ -152,8 +151,7 @@ static u8 chipid_to_nrcores(u16 chipid)
|
|
case 0x4704:
|
|
return 9;
|
|
default:
|
|
- ssb_printk(KERN_ERR PFX
|
|
- "CHIPID not in nrcores fallback list\n");
|
|
+ ssb_err("CHIPID not in nrcores fallback list\n");
|
|
}
|
|
|
|
return 1;
|
|
@@ -320,15 +318,13 @@ int ssb_bus_scan(struct ssb_bus *bus,
|
|
bus->chip_package = 0;
|
|
}
|
|
}
|
|
- ssb_printk(KERN_INFO PFX "Found chip with id 0x%04X, rev 0x%02X and "
|
|
- "package 0x%02X\n", bus->chip_id, bus->chip_rev,
|
|
- bus->chip_package);
|
|
+ ssb_info("Found chip with id 0x%04X, rev 0x%02X and package 0x%02X\n",
|
|
+ bus->chip_id, bus->chip_rev, bus->chip_package);
|
|
if (!bus->nr_devices)
|
|
bus->nr_devices = chipid_to_nrcores(bus->chip_id);
|
|
if (bus->nr_devices > ARRAY_SIZE(bus->devices)) {
|
|
- ssb_printk(KERN_ERR PFX
|
|
- "More than %d ssb cores found (%d)\n",
|
|
- SSB_MAX_NR_CORES, bus->nr_devices);
|
|
+ ssb_err("More than %d ssb cores found (%d)\n",
|
|
+ SSB_MAX_NR_CORES, bus->nr_devices);
|
|
goto err_unmap;
|
|
}
|
|
if (bus->bustype == SSB_BUSTYPE_SSB) {
|
|
@@ -370,8 +366,7 @@ int ssb_bus_scan(struct ssb_bus *bus,
|
|
nr_80211_cores++;
|
|
if (nr_80211_cores > 1) {
|
|
if (!we_support_multiple_80211_cores(bus)) {
|
|
- ssb_dprintk(KERN_INFO PFX "Ignoring additional "
|
|
- "802.11 core\n");
|
|
+ ssb_dbg("Ignoring additional 802.11 core\n");
|
|
continue;
|
|
}
|
|
}
|
|
@@ -379,8 +374,7 @@ int ssb_bus_scan(struct ssb_bus *bus,
|
|
case SSB_DEV_EXTIF:
|
|
#ifdef CONFIG_SSB_DRIVER_EXTIF
|
|
if (bus->extif.dev) {
|
|
- ssb_printk(KERN_WARNING PFX
|
|
- "WARNING: Multiple EXTIFs found\n");
|
|
+ ssb_warn("WARNING: Multiple EXTIFs found\n");
|
|
break;
|
|
}
|
|
bus->extif.dev = dev;
|
|
@@ -388,8 +382,7 @@ int ssb_bus_scan(struct ssb_bus *bus,
|
|
break;
|
|
case SSB_DEV_CHIPCOMMON:
|
|
if (bus->chipco.dev) {
|
|
- ssb_printk(KERN_WARNING PFX
|
|
- "WARNING: Multiple ChipCommon found\n");
|
|
+ ssb_warn("WARNING: Multiple ChipCommon found\n");
|
|
break;
|
|
}
|
|
bus->chipco.dev = dev;
|
|
@@ -398,8 +391,7 @@ int ssb_bus_scan(struct ssb_bus *bus,
|
|
case SSB_DEV_MIPS_3302:
|
|
#ifdef CONFIG_SSB_DRIVER_MIPS
|
|
if (bus->mipscore.dev) {
|
|
- ssb_printk(KERN_WARNING PFX
|
|
- "WARNING: Multiple MIPS cores found\n");
|
|
+ ssb_warn("WARNING: Multiple MIPS cores found\n");
|
|
break;
|
|
}
|
|
bus->mipscore.dev = dev;
|
|
@@ -420,8 +412,7 @@ int ssb_bus_scan(struct ssb_bus *bus,
|
|
}
|
|
}
|
|
if (bus->pcicore.dev) {
|
|
- ssb_printk(KERN_WARNING PFX
|
|
- "WARNING: Multiple PCI(E) cores found\n");
|
|
+ ssb_warn("WARNING: Multiple PCI(E) cores found\n");
|
|
break;
|
|
}
|
|
bus->pcicore.dev = dev;
|
|
--- a/drivers/ssb/sprom.c
|
|
+++ b/drivers/ssb/sprom.c
|
|
@@ -54,7 +54,7 @@ static int hex2sprom(u16 *sprom, const c
|
|
while (cnt < sprom_size_words) {
|
|
memcpy(tmp, dump, 4);
|
|
dump += 4;
|
|
- err = strict_strtoul(tmp, 16, &parsed);
|
|
+ err = kstrtoul(tmp, 16, &parsed);
|
|
if (err)
|
|
return err;
|
|
sprom[cnt++] = swab16((u16)parsed);
|
|
@@ -127,13 +127,13 @@ ssize_t ssb_attr_sprom_store(struct ssb_
|
|
goto out_kfree;
|
|
err = ssb_devices_freeze(bus, &freeze);
|
|
if (err) {
|
|
- ssb_printk(KERN_ERR PFX "SPROM write: Could not freeze all devices\n");
|
|
+ ssb_err("SPROM write: Could not freeze all devices\n");
|
|
goto out_unlock;
|
|
}
|
|
res = sprom_write(bus, sprom);
|
|
err = ssb_devices_thaw(&freeze);
|
|
if (err)
|
|
- ssb_printk(KERN_ERR PFX "SPROM write: Could not thaw all devices\n");
|
|
+ ssb_err("SPROM write: Could not thaw all devices\n");
|
|
out_unlock:
|
|
mutex_unlock(&bus->sprom_mutex);
|
|
out_kfree:
|
|
--- a/drivers/ssb/ssb_private.h
|
|
+++ b/drivers/ssb/ssb_private.h
|
|
@@ -9,16 +9,27 @@
|
|
#define PFX "ssb: "
|
|
|
|
#ifdef CONFIG_SSB_SILENT
|
|
-# define ssb_printk(fmt, x...) do { /* nothing */ } while (0)
|
|
+# define ssb_printk(fmt, ...) \
|
|
+ do { if (0) printk(fmt, ##__VA_ARGS__); } while (0)
|
|
#else
|
|
-# define ssb_printk printk
|
|
+# define ssb_printk(fmt, ...) \
|
|
+ printk(fmt, ##__VA_ARGS__)
|
|
#endif /* CONFIG_SSB_SILENT */
|
|
|
|
+#define ssb_emerg(fmt, ...) ssb_printk(KERN_EMERG PFX fmt, ##__VA_ARGS__)
|
|
+#define ssb_err(fmt, ...) ssb_printk(KERN_ERR PFX fmt, ##__VA_ARGS__)
|
|
+#define ssb_warn(fmt, ...) ssb_printk(KERN_WARNING PFX fmt, ##__VA_ARGS__)
|
|
+#define ssb_notice(fmt, ...) ssb_printk(KERN_NOTICE PFX fmt, ##__VA_ARGS__)
|
|
+#define ssb_info(fmt, ...) ssb_printk(KERN_INFO PFX fmt, ##__VA_ARGS__)
|
|
+#define ssb_cont(fmt, ...) ssb_printk(KERN_CONT fmt, ##__VA_ARGS__)
|
|
+
|
|
/* dprintk: Debugging printk; vanishes for non-debug compilation */
|
|
#ifdef CONFIG_SSB_DEBUG
|
|
-# define ssb_dprintk(fmt, x...) ssb_printk(fmt , ##x)
|
|
+# define ssb_dbg(fmt, ...) \
|
|
+ ssb_printk(KERN_DEBUG PFX fmt, ##__VA_ARGS__)
|
|
#else
|
|
-# define ssb_dprintk(fmt, x...) do { /* nothing */ } while (0)
|
|
+# define ssb_dbg(fmt, ...) \
|
|
+ do { if (0) printk(KERN_DEBUG PFX fmt, ##__VA_ARGS__); } while (0)
|
|
#endif
|
|
|
|
#ifdef CONFIG_SSB_DEBUG
|
|
@@ -232,6 +243,10 @@ static inline int ssb_sflash_init(struct
|
|
extern struct platform_device ssb_pflash_dev;
|
|
#endif
|
|
|
|
+#ifdef CONFIG_SSB_SFLASH
|
|
+extern struct platform_device ssb_sflash_dev;
|
|
+#endif
|
|
+
|
|
#ifdef CONFIG_SSB_DRIVER_EXTIF
|
|
extern u32 ssb_extif_watchdog_timer_set_wdt(struct bcm47xx_wdt *wdt, u32 ticks);
|
|
extern u32 ssb_extif_watchdog_timer_set_ms(struct bcm47xx_wdt *wdt, u32 ms);
|
|
--- a/include/linux/ssb/ssb.h
|
|
+++ b/include/linux/ssb/ssb.h
|
|
@@ -26,13 +26,14 @@ struct ssb_sprom_core_pwr_info {
|
|
|
|
struct ssb_sprom {
|
|
u8 revision;
|
|
- u8 il0mac[6]; /* MAC address for 802.11b/g */
|
|
- u8 et0mac[6]; /* MAC address for Ethernet */
|
|
- u8 et1mac[6]; /* MAC address for 802.11a */
|
|
+ u8 il0mac[6] __aligned(sizeof(u16)); /* MAC address for 802.11b/g */
|
|
+ u8 et0mac[6] __aligned(sizeof(u16)); /* MAC address for Ethernet */
|
|
+ u8 et1mac[6] __aligned(sizeof(u16)); /* MAC address for 802.11a */
|
|
u8 et0phyaddr; /* MII address for enet0 */
|
|
u8 et1phyaddr; /* MII address for enet1 */
|
|
u8 et0mdcport; /* MDIO for enet0 */
|
|
u8 et1mdcport; /* MDIO for enet1 */
|
|
+ u16 dev_id; /* Device ID overriding e.g. PCI ID */
|
|
u16 board_rev; /* Board revision number from SPROM. */
|
|
u16 board_num; /* Board number from SPROM. */
|
|
u16 board_type; /* Board type from SPROM. */
|
|
@@ -340,13 +341,61 @@ enum ssb_bustype {
|
|
#define SSB_BOARDVENDOR_DELL 0x1028 /* Dell */
|
|
#define SSB_BOARDVENDOR_HP 0x0E11 /* HP */
|
|
/* board_type */
|
|
+#define SSB_BOARD_BCM94301CB 0x0406
|
|
+#define SSB_BOARD_BCM94301MP 0x0407
|
|
+#define SSB_BOARD_BU4309 0x040A
|
|
+#define SSB_BOARD_BCM94309CB 0x040B
|
|
+#define SSB_BOARD_BCM4309MP 0x040C
|
|
+#define SSB_BOARD_BU4306 0x0416
|
|
#define SSB_BOARD_BCM94306MP 0x0418
|
|
#define SSB_BOARD_BCM4309G 0x0421
|
|
#define SSB_BOARD_BCM4306CB 0x0417
|
|
-#define SSB_BOARD_BCM4309MP 0x040C
|
|
+#define SSB_BOARD_BCM94306PC 0x0425 /* pcmcia 3.3v 4306 card */
|
|
+#define SSB_BOARD_BCM94306CBSG 0x042B /* with SiGe PA */
|
|
+#define SSB_BOARD_PCSG94306 0x042D /* with SiGe PA */
|
|
+#define SSB_BOARD_BU4704SD 0x042E /* with sdram */
|
|
+#define SSB_BOARD_BCM94704AGR 0x042F /* dual 11a/11g Router */
|
|
+#define SSB_BOARD_BCM94308MP 0x0430 /* 11a-only minipci */
|
|
+#define SSB_BOARD_BU4318 0x0447
|
|
+#define SSB_BOARD_CB4318 0x0448
|
|
+#define SSB_BOARD_MPG4318 0x0449
|
|
#define SSB_BOARD_MP4318 0x044A
|
|
-#define SSB_BOARD_BU4306 0x0416
|
|
-#define SSB_BOARD_BU4309 0x040A
|
|
+#define SSB_BOARD_SD4318 0x044B
|
|
+#define SSB_BOARD_BCM94306P 0x044C /* with SiGe */
|
|
+#define SSB_BOARD_BCM94303MP 0x044E
|
|
+#define SSB_BOARD_BCM94306MPM 0x0450
|
|
+#define SSB_BOARD_BCM94306MPL 0x0453
|
|
+#define SSB_BOARD_PC4303 0x0454 /* pcmcia */
|
|
+#define SSB_BOARD_BCM94306MPLNA 0x0457
|
|
+#define SSB_BOARD_BCM94306MPH 0x045B
|
|
+#define SSB_BOARD_BCM94306PCIV 0x045C
|
|
+#define SSB_BOARD_BCM94318MPGH 0x0463
|
|
+#define SSB_BOARD_BU4311 0x0464
|
|
+#define SSB_BOARD_BCM94311MC 0x0465
|
|
+#define SSB_BOARD_BCM94311MCAG 0x0466
|
|
+/* 4321 boards */
|
|
+#define SSB_BOARD_BU4321 0x046B
|
|
+#define SSB_BOARD_BU4321E 0x047C
|
|
+#define SSB_BOARD_MP4321 0x046C
|
|
+#define SSB_BOARD_CB2_4321 0x046D
|
|
+#define SSB_BOARD_CB2_4321_AG 0x0066
|
|
+#define SSB_BOARD_MC4321 0x046E
|
|
+/* 4325 boards */
|
|
+#define SSB_BOARD_BCM94325DEVBU 0x0490
|
|
+#define SSB_BOARD_BCM94325BGABU 0x0491
|
|
+#define SSB_BOARD_BCM94325SDGWB 0x0492
|
|
+#define SSB_BOARD_BCM94325SDGMDL 0x04AA
|
|
+#define SSB_BOARD_BCM94325SDGMDL2 0x04C6
|
|
+#define SSB_BOARD_BCM94325SDGMDL3 0x04C9
|
|
+#define SSB_BOARD_BCM94325SDABGWBA 0x04E1
|
|
+/* 4322 boards */
|
|
+#define SSB_BOARD_BCM94322MC 0x04A4
|
|
+#define SSB_BOARD_BCM94322USB 0x04A8 /* dualband */
|
|
+#define SSB_BOARD_BCM94322HM 0x04B0
|
|
+#define SSB_BOARD_BCM94322USB2D 0x04Bf /* single band discrete front end */
|
|
+/* 4312 boards */
|
|
+#define SSB_BOARD_BU4312 0x048A
|
|
+#define SSB_BOARD_BCM4312MCGSG 0x04B5
|
|
/* chip_package */
|
|
#define SSB_CHIPPACK_BCM4712S 1 /* Small 200pin 4712 */
|
|
#define SSB_CHIPPACK_BCM4712M 2 /* Medium 225pin 4712 */
|
|
--- a/include/linux/ssb/ssb_driver_mips.h
|
|
+++ b/include/linux/ssb/ssb_driver_mips.h
|
|
@@ -20,6 +20,18 @@ struct ssb_pflash {
|
|
u32 window_size;
|
|
};
|
|
|
|
+#ifdef CONFIG_SSB_SFLASH
|
|
+struct ssb_sflash {
|
|
+ bool present;
|
|
+ u32 window;
|
|
+ u32 blocksize;
|
|
+ u16 numblocks;
|
|
+ u32 size;
|
|
+
|
|
+ void *priv;
|
|
+};
|
|
+#endif
|
|
+
|
|
struct ssb_mipscore {
|
|
struct ssb_device *dev;
|
|
|
|
@@ -27,6 +39,9 @@ struct ssb_mipscore {
|
|
struct ssb_serial_port serial_ports[4];
|
|
|
|
struct ssb_pflash pflash;
|
|
+#ifdef CONFIG_SSB_SFLASH
|
|
+ struct ssb_sflash sflash;
|
|
+#endif
|
|
};
|
|
|
|
extern void ssb_mipscore_init(struct ssb_mipscore *mcore);
|
|
--- a/include/linux/ssb/ssb_regs.h
|
|
+++ b/include/linux/ssb/ssb_regs.h
|
|
@@ -172,6 +172,7 @@
|
|
#define SSB_SPROMSIZE_WORDS_R4 220
|
|
#define SSB_SPROMSIZE_BYTES_R123 (SSB_SPROMSIZE_WORDS_R123 * sizeof(u16))
|
|
#define SSB_SPROMSIZE_BYTES_R4 (SSB_SPROMSIZE_WORDS_R4 * sizeof(u16))
|
|
+#define SSB_SPROMSIZE_WORDS_R10 230
|
|
#define SSB_SPROM_BASE1 0x1000
|
|
#define SSB_SPROM_BASE31 0x0800
|
|
#define SSB_SPROM_REVISION 0x007E
|
|
@@ -289,11 +290,11 @@
|
|
#define SSB_SPROM4_ETHPHY_ET1A_SHIFT 5
|
|
#define SSB_SPROM4_ETHPHY_ET0M (1<<14) /* MDIO for enet0 */
|
|
#define SSB_SPROM4_ETHPHY_ET1M (1<<15) /* MDIO for enet1 */
|
|
-#define SSB_SPROM4_ANTAVAIL 0x005D /* Antenna available bitfields */
|
|
-#define SSB_SPROM4_ANTAVAIL_A 0x00FF /* A-PHY bitfield */
|
|
-#define SSB_SPROM4_ANTAVAIL_A_SHIFT 0
|
|
-#define SSB_SPROM4_ANTAVAIL_BG 0xFF00 /* B-PHY and G-PHY bitfield */
|
|
-#define SSB_SPROM4_ANTAVAIL_BG_SHIFT 8
|
|
+#define SSB_SPROM4_ANTAVAIL 0x005C /* Antenna available bitfields */
|
|
+#define SSB_SPROM4_ANTAVAIL_BG 0x00FF /* B-PHY and G-PHY bitfield */
|
|
+#define SSB_SPROM4_ANTAVAIL_BG_SHIFT 0
|
|
+#define SSB_SPROM4_ANTAVAIL_A 0xFF00 /* A-PHY bitfield */
|
|
+#define SSB_SPROM4_ANTAVAIL_A_SHIFT 8
|
|
#define SSB_SPROM4_AGAIN01 0x005E /* Antenna Gain (in dBm Q5.2) */
|
|
#define SSB_SPROM4_AGAIN0 0x00FF /* Antenna 0 */
|
|
#define SSB_SPROM4_AGAIN0_SHIFT 0
|
|
--- a/arch/mips/bcm47xx/sprom.c
|
|
+++ b/arch/mips/bcm47xx/sprom.c
|
|
@@ -168,6 +168,7 @@ static void nvram_read_alpha2(const char
|
|
static void bcm47xx_fill_sprom_r1234589(struct ssb_sprom *sprom,
|
|
const char *prefix, bool fallback)
|
|
{
|
|
+ nvram_read_u16(prefix, NULL, "devid", &sprom->dev_id, 0, fallback);
|
|
nvram_read_u8(prefix, NULL, "ledbh0", &sprom->gpio0, 0xff, fallback);
|
|
nvram_read_u8(prefix, NULL, "ledbh1", &sprom->gpio1, 0xff, fallback);
|
|
nvram_read_u8(prefix, NULL, "ledbh2", &sprom->gpio2, 0xff, fallback);
|