thp: avoid dumping huge zero page
[linux-2.6/libata-dev.git] / drivers / ssb / scan.c
blobab4627cf11148c96a969ebd966c4657265e49471
1 /*
2 * Sonics Silicon Backplane
3 * Bus scanning
5 * Copyright (C) 2005-2007 Michael Buesch <m@bues.ch>
6 * Copyright (C) 2005 Martin Langer <martin-langer@gmx.de>
7 * Copyright (C) 2005 Stefano Brivio <st3@riseup.net>
8 * Copyright (C) 2005 Danny van Dyk <kugelfang@gentoo.org>
9 * Copyright (C) 2005 Andreas Jaggi <andreas.jaggi@waterwave.ch>
10 * Copyright (C) 2006 Broadcom Corporation.
12 * Licensed under the GNU/GPL. See COPYING for details.
15 #include <linux/ssb/ssb.h>
16 #include <linux/ssb/ssb_regs.h>
17 #include <linux/pci.h>
18 #include <linux/io.h>
20 #include <pcmcia/cistpl.h>
21 #include <pcmcia/ds.h>
23 #include "ssb_private.h"
26 const char *ssb_core_name(u16 coreid)
28 switch (coreid) {
29 case SSB_DEV_CHIPCOMMON:
30 return "ChipCommon";
31 case SSB_DEV_ILINE20:
32 return "ILine 20";
33 case SSB_DEV_SDRAM:
34 return "SDRAM";
35 case SSB_DEV_PCI:
36 return "PCI";
37 case SSB_DEV_MIPS:
38 return "MIPS";
39 case SSB_DEV_ETHERNET:
40 return "Fast Ethernet";
41 case SSB_DEV_V90:
42 return "V90";
43 case SSB_DEV_USB11_HOSTDEV:
44 return "USB 1.1 Hostdev";
45 case SSB_DEV_ADSL:
46 return "ADSL";
47 case SSB_DEV_ILINE100:
48 return "ILine 100";
49 case SSB_DEV_IPSEC:
50 return "IPSEC";
51 case SSB_DEV_PCMCIA:
52 return "PCMCIA";
53 case SSB_DEV_INTERNAL_MEM:
54 return "Internal Memory";
55 case SSB_DEV_MEMC_SDRAM:
56 return "MEMC SDRAM";
57 case SSB_DEV_EXTIF:
58 return "EXTIF";
59 case SSB_DEV_80211:
60 return "IEEE 802.11";
61 case SSB_DEV_MIPS_3302:
62 return "MIPS 3302";
63 case SSB_DEV_USB11_HOST:
64 return "USB 1.1 Host";
65 case SSB_DEV_USB11_DEV:
66 return "USB 1.1 Device";
67 case SSB_DEV_USB20_HOST:
68 return "USB 2.0 Host";
69 case SSB_DEV_USB20_DEV:
70 return "USB 2.0 Device";
71 case SSB_DEV_SDIO_HOST:
72 return "SDIO Host";
73 case SSB_DEV_ROBOSWITCH:
74 return "Roboswitch";
75 case SSB_DEV_PARA_ATA:
76 return "PATA";
77 case SSB_DEV_SATA_XORDMA:
78 return "SATA XOR-DMA";
79 case SSB_DEV_ETHERNET_GBIT:
80 return "GBit Ethernet";
81 case SSB_DEV_PCIE:
82 return "PCI-E";
83 case SSB_DEV_MIMO_PHY:
84 return "MIMO PHY";
85 case SSB_DEV_SRAM_CTRLR:
86 return "SRAM Controller";
87 case SSB_DEV_MINI_MACPHY:
88 return "Mini MACPHY";
89 case SSB_DEV_ARM_1176:
90 return "ARM 1176";
91 case SSB_DEV_ARM_7TDMI:
92 return "ARM 7TDMI";
93 case SSB_DEV_ARM_CM3:
94 return "ARM Cortex M3";
96 return "UNKNOWN";
99 static u16 pcidev_to_chipid(struct pci_dev *pci_dev)
101 u16 chipid_fallback = 0;
103 switch (pci_dev->device) {
104 case 0x4301:
105 chipid_fallback = 0x4301;
106 break;
107 case 0x4305 ... 0x4307:
108 chipid_fallback = 0x4307;
109 break;
110 case 0x4403:
111 chipid_fallback = 0x4402;
112 break;
113 case 0x4610 ... 0x4615:
114 chipid_fallback = 0x4610;
115 break;
116 case 0x4710 ... 0x4715:
117 chipid_fallback = 0x4710;
118 break;
119 case 0x4320 ... 0x4325:
120 chipid_fallback = 0x4309;
121 break;
122 case PCI_DEVICE_ID_BCM4401:
123 case PCI_DEVICE_ID_BCM4401B0:
124 case PCI_DEVICE_ID_BCM4401B1:
125 chipid_fallback = 0x4401;
126 break;
127 default:
128 ssb_printk(KERN_ERR PFX
129 "PCI-ID not in fallback list\n");
132 return chipid_fallback;
135 static u8 chipid_to_nrcores(u16 chipid)
137 switch (chipid) {
138 case 0x5365:
139 return 7;
140 case 0x4306:
141 return 6;
142 case 0x4310:
143 return 8;
144 case 0x4307:
145 case 0x4301:
146 return 5;
147 case 0x4401:
148 case 0x4402:
149 return 3;
150 case 0x4710:
151 case 0x4610:
152 case 0x4704:
153 return 9;
154 default:
155 ssb_printk(KERN_ERR PFX
156 "CHIPID not in nrcores fallback list\n");
159 return 1;
162 static u32 scan_read32(struct ssb_bus *bus, u8 current_coreidx,
163 u16 offset)
165 u32 lo, hi;
167 switch (bus->bustype) {
168 case SSB_BUSTYPE_SSB:
169 offset += current_coreidx * SSB_CORE_SIZE;
170 break;
171 case SSB_BUSTYPE_PCI:
172 break;
173 case SSB_BUSTYPE_PCMCIA:
174 if (offset >= 0x800) {
175 ssb_pcmcia_switch_segment(bus, 1);
176 offset -= 0x800;
177 } else
178 ssb_pcmcia_switch_segment(bus, 0);
179 lo = readw(bus->mmio + offset);
180 hi = readw(bus->mmio + offset + 2);
181 return lo | (hi << 16);
182 case SSB_BUSTYPE_SDIO:
183 offset += current_coreidx * SSB_CORE_SIZE;
184 return ssb_sdio_scan_read32(bus, offset);
186 return readl(bus->mmio + offset);
189 static int scan_switchcore(struct ssb_bus *bus, u8 coreidx)
191 switch (bus->bustype) {
192 case SSB_BUSTYPE_SSB:
193 break;
194 case SSB_BUSTYPE_PCI:
195 return ssb_pci_switch_coreidx(bus, coreidx);
196 case SSB_BUSTYPE_PCMCIA:
197 return ssb_pcmcia_switch_coreidx(bus, coreidx);
198 case SSB_BUSTYPE_SDIO:
199 return ssb_sdio_scan_switch_coreidx(bus, coreidx);
201 return 0;
204 void ssb_iounmap(struct ssb_bus *bus)
206 switch (bus->bustype) {
207 case SSB_BUSTYPE_SSB:
208 case SSB_BUSTYPE_PCMCIA:
209 iounmap(bus->mmio);
210 break;
211 case SSB_BUSTYPE_PCI:
212 #ifdef CONFIG_SSB_PCIHOST
213 pci_iounmap(bus->host_pci, bus->mmio);
214 #else
215 SSB_BUG_ON(1); /* Can't reach this code. */
216 #endif
217 break;
218 case SSB_BUSTYPE_SDIO:
219 break;
221 bus->mmio = NULL;
222 bus->mapped_device = NULL;
225 static void __iomem *ssb_ioremap(struct ssb_bus *bus,
226 unsigned long baseaddr)
228 void __iomem *mmio = NULL;
230 switch (bus->bustype) {
231 case SSB_BUSTYPE_SSB:
232 /* Only map the first core for now. */
233 /* fallthrough... */
234 case SSB_BUSTYPE_PCMCIA:
235 mmio = ioremap(baseaddr, SSB_CORE_SIZE);
236 break;
237 case SSB_BUSTYPE_PCI:
238 #ifdef CONFIG_SSB_PCIHOST
239 mmio = pci_iomap(bus->host_pci, 0, ~0UL);
240 #else
241 SSB_BUG_ON(1); /* Can't reach this code. */
242 #endif
243 break;
244 case SSB_BUSTYPE_SDIO:
245 /* Nothing to ioremap in the SDIO case, just fake it */
246 mmio = (void __iomem *)baseaddr;
247 break;
250 return mmio;
253 static int we_support_multiple_80211_cores(struct ssb_bus *bus)
255 /* More than one 802.11 core is only supported by special chips.
256 * There are chips with two 802.11 cores, but with dangling
257 * pins on the second core. Be careful and reject them here.
260 #ifdef CONFIG_SSB_PCIHOST
261 if (bus->bustype == SSB_BUSTYPE_PCI) {
262 if (bus->host_pci->vendor == PCI_VENDOR_ID_BROADCOM &&
263 ((bus->host_pci->device == 0x4313) ||
264 (bus->host_pci->device == 0x431A) ||
265 (bus->host_pci->device == 0x4321) ||
266 (bus->host_pci->device == 0x4324)))
267 return 1;
269 #endif /* CONFIG_SSB_PCIHOST */
270 return 0;
273 int ssb_bus_scan(struct ssb_bus *bus,
274 unsigned long baseaddr)
276 int err = -ENOMEM;
277 void __iomem *mmio;
278 u32 idhi, cc, rev, tmp;
279 int dev_i, i;
280 struct ssb_device *dev;
281 int nr_80211_cores = 0;
283 mmio = ssb_ioremap(bus, baseaddr);
284 if (!mmio)
285 goto out;
286 bus->mmio = mmio;
288 err = scan_switchcore(bus, 0); /* Switch to first core */
289 if (err)
290 goto err_unmap;
292 idhi = scan_read32(bus, 0, SSB_IDHIGH);
293 cc = (idhi & SSB_IDHIGH_CC) >> SSB_IDHIGH_CC_SHIFT;
294 rev = (idhi & SSB_IDHIGH_RCLO);
295 rev |= (idhi & SSB_IDHIGH_RCHI) >> SSB_IDHIGH_RCHI_SHIFT;
297 bus->nr_devices = 0;
298 if (cc == SSB_DEV_CHIPCOMMON) {
299 tmp = scan_read32(bus, 0, SSB_CHIPCO_CHIPID);
301 bus->chip_id = (tmp & SSB_CHIPCO_IDMASK);
302 bus->chip_rev = (tmp & SSB_CHIPCO_REVMASK) >>
303 SSB_CHIPCO_REVSHIFT;
304 bus->chip_package = (tmp & SSB_CHIPCO_PACKMASK) >>
305 SSB_CHIPCO_PACKSHIFT;
306 if (rev >= 4) {
307 bus->nr_devices = (tmp & SSB_CHIPCO_NRCORESMASK) >>
308 SSB_CHIPCO_NRCORESSHIFT;
310 tmp = scan_read32(bus, 0, SSB_CHIPCO_CAP);
311 bus->chipco.capabilities = tmp;
312 } else {
313 if (bus->bustype == SSB_BUSTYPE_PCI) {
314 bus->chip_id = pcidev_to_chipid(bus->host_pci);
315 bus->chip_rev = bus->host_pci->revision;
316 bus->chip_package = 0;
317 } else {
318 bus->chip_id = 0x4710;
319 bus->chip_rev = 0;
320 bus->chip_package = 0;
323 ssb_printk(KERN_INFO PFX "Found chip with id 0x%04X, rev 0x%02X and "
324 "package 0x%02X\n", bus->chip_id, bus->chip_rev,
325 bus->chip_package);
326 if (!bus->nr_devices)
327 bus->nr_devices = chipid_to_nrcores(bus->chip_id);
328 if (bus->nr_devices > ARRAY_SIZE(bus->devices)) {
329 ssb_printk(KERN_ERR PFX
330 "More than %d ssb cores found (%d)\n",
331 SSB_MAX_NR_CORES, bus->nr_devices);
332 goto err_unmap;
334 if (bus->bustype == SSB_BUSTYPE_SSB) {
335 /* Now that we know the number of cores,
336 * remap the whole IO space for all cores.
338 err = -ENOMEM;
339 iounmap(mmio);
340 mmio = ioremap(baseaddr, SSB_CORE_SIZE * bus->nr_devices);
341 if (!mmio)
342 goto out;
343 bus->mmio = mmio;
346 /* Fetch basic information about each core/device */
347 for (i = 0, dev_i = 0; i < bus->nr_devices; i++) {
348 err = scan_switchcore(bus, i);
349 if (err)
350 goto err_unmap;
351 dev = &(bus->devices[dev_i]);
353 idhi = scan_read32(bus, i, SSB_IDHIGH);
354 dev->id.coreid = (idhi & SSB_IDHIGH_CC) >> SSB_IDHIGH_CC_SHIFT;
355 dev->id.revision = (idhi & SSB_IDHIGH_RCLO);
356 dev->id.revision |= (idhi & SSB_IDHIGH_RCHI) >> SSB_IDHIGH_RCHI_SHIFT;
357 dev->id.vendor = (idhi & SSB_IDHIGH_VC) >> SSB_IDHIGH_VC_SHIFT;
358 dev->core_index = i;
359 dev->bus = bus;
360 dev->ops = bus->ops;
362 printk(KERN_DEBUG PFX
363 "Core %d found: %s "
364 "(cc 0x%03X, rev 0x%02X, vendor 0x%04X)\n",
365 i, ssb_core_name(dev->id.coreid),
366 dev->id.coreid, dev->id.revision, dev->id.vendor);
368 switch (dev->id.coreid) {
369 case SSB_DEV_80211:
370 nr_80211_cores++;
371 if (nr_80211_cores > 1) {
372 if (!we_support_multiple_80211_cores(bus)) {
373 ssb_dprintk(KERN_INFO PFX "Ignoring additional "
374 "802.11 core\n");
375 continue;
378 break;
379 case SSB_DEV_EXTIF:
380 #ifdef CONFIG_SSB_DRIVER_EXTIF
381 if (bus->extif.dev) {
382 ssb_printk(KERN_WARNING PFX
383 "WARNING: Multiple EXTIFs found\n");
384 break;
386 bus->extif.dev = dev;
387 #endif /* CONFIG_SSB_DRIVER_EXTIF */
388 break;
389 case SSB_DEV_CHIPCOMMON:
390 if (bus->chipco.dev) {
391 ssb_printk(KERN_WARNING PFX
392 "WARNING: Multiple ChipCommon found\n");
393 break;
395 bus->chipco.dev = dev;
396 break;
397 case SSB_DEV_MIPS:
398 case SSB_DEV_MIPS_3302:
399 #ifdef CONFIG_SSB_DRIVER_MIPS
400 if (bus->mipscore.dev) {
401 ssb_printk(KERN_WARNING PFX
402 "WARNING: Multiple MIPS cores found\n");
403 break;
405 bus->mipscore.dev = dev;
406 #endif /* CONFIG_SSB_DRIVER_MIPS */
407 break;
408 case SSB_DEV_PCI:
409 case SSB_DEV_PCIE:
410 #ifdef CONFIG_SSB_DRIVER_PCICORE
411 if (bus->bustype == SSB_BUSTYPE_PCI) {
412 /* Ignore PCI cores on PCI-E cards.
413 * Ignore PCI-E cores on PCI cards. */
414 if (dev->id.coreid == SSB_DEV_PCI) {
415 if (pci_is_pcie(bus->host_pci))
416 continue;
417 } else {
418 if (!pci_is_pcie(bus->host_pci))
419 continue;
422 if (bus->pcicore.dev) {
423 ssb_printk(KERN_WARNING PFX
424 "WARNING: Multiple PCI(E) cores found\n");
425 break;
427 bus->pcicore.dev = dev;
428 #endif /* CONFIG_SSB_DRIVER_PCICORE */
429 break;
430 case SSB_DEV_ETHERNET:
431 if (bus->bustype == SSB_BUSTYPE_PCI) {
432 if (bus->host_pci->vendor == PCI_VENDOR_ID_BROADCOM &&
433 (bus->host_pci->device & 0xFF00) == 0x4300) {
434 /* This is a dangling ethernet core on a
435 * wireless device. Ignore it. */
436 continue;
439 break;
440 default:
441 break;
444 dev_i++;
446 bus->nr_devices = dev_i;
448 err = 0;
449 out:
450 return err;
451 err_unmap:
452 ssb_iounmap(bus);
453 goto out;