1
2
3
4
5
6
7
8
9
10
11
12
13
14
15#include <linux/ssb/ssb.h>
16#include <linux/ssb/ssb_regs.h>
17#include <linux/pci.h>
18#include <linux/io.h>
19
20#include <pcmcia/cistpl.h>
21#include <pcmcia/ds.h>
22
23#include "ssb_private.h"
24
25
26const char *ssb_core_name(u16 coreid)
27{
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 }
94 return "UNKNOWN";
95}
96
97static u16 pcidev_to_chipid(struct pci_dev *pci_dev)
98{
99 u16 chipid_fallback = 0;
100
101 switch (pci_dev->device) {
102 case 0x4301:
103 chipid_fallback = 0x4301;
104 break;
105 case 0x4305 ... 0x4307:
106 chipid_fallback = 0x4307;
107 break;
108 case 0x4403:
109 chipid_fallback = 0x4402;
110 break;
111 case 0x4610 ... 0x4615:
112 chipid_fallback = 0x4610;
113 break;
114 case 0x4710 ... 0x4715:
115 chipid_fallback = 0x4710;
116 break;
117 case 0x4320 ... 0x4325:
118 chipid_fallback = 0x4309;
119 break;
120 case PCI_DEVICE_ID_BCM4401:
121 case PCI_DEVICE_ID_BCM4401B0:
122 case PCI_DEVICE_ID_BCM4401B1:
123 chipid_fallback = 0x4401;
124 break;
125 default:
126 ssb_printk(KERN_ERR PFX
127 "PCI-ID not in fallback list\n");
128 }
129
130 return chipid_fallback;
131}
132
133static u8 chipid_to_nrcores(u16 chipid)
134{
135 switch (chipid) {
136 case 0x5365:
137 return 7;
138 case 0x4306:
139 return 6;
140 case 0x4310:
141 return 8;
142 case 0x4307:
143 case 0x4301:
144 return 5;
145 case 0x4401:
146 case 0x4402:
147 return 3;
148 case 0x4710:
149 case 0x4610:
150 case 0x4704:
151 return 9;
152 default:
153 ssb_printk(KERN_ERR PFX
154 "CHIPID not in nrcores fallback list\n");
155 }
156
157 return 1;
158}
159
160static u32 scan_read32(struct ssb_bus *bus, u8 current_coreidx,
161 u16 offset)
162{
163 u32 lo, hi;
164
165 switch (bus->bustype) {
166 case SSB_BUSTYPE_SSB:
167 offset += current_coreidx * SSB_CORE_SIZE;
168 break;
169 case SSB_BUSTYPE_PCI:
170 break;
171 case SSB_BUSTYPE_PCMCIA:
172 if (offset >= 0x800) {
173 ssb_pcmcia_switch_segment(bus, 1);
174 offset -= 0x800;
175 } else
176 ssb_pcmcia_switch_segment(bus, 0);
177 lo = readw(bus->mmio + offset);
178 hi = readw(bus->mmio + offset + 2);
179 return lo | (hi << 16);
180 case SSB_BUSTYPE_SDIO:
181 offset += current_coreidx * SSB_CORE_SIZE;
182 return ssb_sdio_scan_read32(bus, offset);
183 }
184 return readl(bus->mmio + offset);
185}
186
187static int scan_switchcore(struct ssb_bus *bus, u8 coreidx)
188{
189 switch (bus->bustype) {
190 case SSB_BUSTYPE_SSB:
191 break;
192 case SSB_BUSTYPE_PCI:
193 return ssb_pci_switch_coreidx(bus, coreidx);
194 case SSB_BUSTYPE_PCMCIA:
195 return ssb_pcmcia_switch_coreidx(bus, coreidx);
196 case SSB_BUSTYPE_SDIO:
197 return ssb_sdio_scan_switch_coreidx(bus, coreidx);
198 }
199 return 0;
200}
201
202void ssb_iounmap(struct ssb_bus *bus)
203{
204 switch (bus->bustype) {
205 case SSB_BUSTYPE_SSB:
206 case SSB_BUSTYPE_PCMCIA:
207 iounmap(bus->mmio);
208 break;
209 case SSB_BUSTYPE_PCI:
210#ifdef CONFIG_SSB_PCIHOST
211 pci_iounmap(bus->host_pci, bus->mmio);
212#else
213 SSB_BUG_ON(1);
214#endif
215 break;
216 case SSB_BUSTYPE_SDIO:
217 break;
218 }
219 bus->mmio = NULL;
220 bus->mapped_device = NULL;
221}
222
223static void __iomem *ssb_ioremap(struct ssb_bus *bus,
224 unsigned long baseaddr)
225{
226 void __iomem *mmio = NULL;
227
228 switch (bus->bustype) {
229 case SSB_BUSTYPE_SSB:
230
231
232 case SSB_BUSTYPE_PCMCIA:
233 mmio = ioremap(baseaddr, SSB_CORE_SIZE);
234 break;
235 case SSB_BUSTYPE_PCI:
236#ifdef CONFIG_SSB_PCIHOST
237 mmio = pci_iomap(bus->host_pci, 0, ~0UL);
238#else
239 SSB_BUG_ON(1);
240#endif
241 break;
242 case SSB_BUSTYPE_SDIO:
243
244 mmio = (void __iomem *)baseaddr;
245 break;
246 }
247
248 return mmio;
249}
250
251static int we_support_multiple_80211_cores(struct ssb_bus *bus)
252{
253
254
255
256
257
258#ifdef CONFIG_SSB_PCIHOST
259 if (bus->bustype == SSB_BUSTYPE_PCI) {
260 if (bus->host_pci->vendor == PCI_VENDOR_ID_BROADCOM &&
261 ((bus->host_pci->device == 0x4313) ||
262 (bus->host_pci->device == 0x431A) ||
263 (bus->host_pci->device == 0x4321) ||
264 (bus->host_pci->device == 0x4324)))
265 return 1;
266 }
267#endif
268 return 0;
269}
270
271int ssb_bus_scan(struct ssb_bus *bus,
272 unsigned long baseaddr)
273{
274 int err = -ENOMEM;
275 void __iomem *mmio;
276 u32 idhi, cc, rev, tmp;
277 int dev_i, i;
278 struct ssb_device *dev;
279 int nr_80211_cores = 0;
280
281 mmio = ssb_ioremap(bus, baseaddr);
282 if (!mmio)
283 goto out;
284 bus->mmio = mmio;
285
286 err = scan_switchcore(bus, 0);
287 if (err)
288 goto err_unmap;
289
290 idhi = scan_read32(bus, 0, SSB_IDHIGH);
291 cc = (idhi & SSB_IDHIGH_CC) >> SSB_IDHIGH_CC_SHIFT;
292 rev = (idhi & SSB_IDHIGH_RCLO);
293 rev |= (idhi & SSB_IDHIGH_RCHI) >> SSB_IDHIGH_RCHI_SHIFT;
294
295 bus->nr_devices = 0;
296 if (cc == SSB_DEV_CHIPCOMMON) {
297 tmp = scan_read32(bus, 0, SSB_CHIPCO_CHIPID);
298
299 bus->chip_id = (tmp & SSB_CHIPCO_IDMASK);
300 bus->chip_rev = (tmp & SSB_CHIPCO_REVMASK) >>
301 SSB_CHIPCO_REVSHIFT;
302 bus->chip_package = (tmp & SSB_CHIPCO_PACKMASK) >>
303 SSB_CHIPCO_PACKSHIFT;
304 if (rev >= 4) {
305 bus->nr_devices = (tmp & SSB_CHIPCO_NRCORESMASK) >>
306 SSB_CHIPCO_NRCORESSHIFT;
307 }
308 tmp = scan_read32(bus, 0, SSB_CHIPCO_CAP);
309 bus->chipco.capabilities = tmp;
310 } else {
311 if (bus->bustype == SSB_BUSTYPE_PCI) {
312 bus->chip_id = pcidev_to_chipid(bus->host_pci);
313 bus->chip_rev = bus->host_pci->revision;
314 bus->chip_package = 0;
315 } else {
316 bus->chip_id = 0x4710;
317 bus->chip_rev = 0;
318 bus->chip_package = 0;
319 }
320 }
321 if (!bus->nr_devices)
322 bus->nr_devices = chipid_to_nrcores(bus->chip_id);
323 if (bus->nr_devices > ARRAY_SIZE(bus->devices)) {
324 ssb_printk(KERN_ERR PFX
325 "More than %d ssb cores found (%d)\n",
326 SSB_MAX_NR_CORES, bus->nr_devices);
327 goto err_unmap;
328 }
329 if (bus->bustype == SSB_BUSTYPE_SSB) {
330
331
332
333 err = -ENOMEM;
334 iounmap(mmio);
335 mmio = ioremap(baseaddr, SSB_CORE_SIZE * bus->nr_devices);
336 if (!mmio)
337 goto out;
338 bus->mmio = mmio;
339 }
340
341
342 for (i = 0, dev_i = 0; i < bus->nr_devices; i++) {
343 err = scan_switchcore(bus, i);
344 if (err)
345 goto err_unmap;
346 dev = &(bus->devices[dev_i]);
347
348 idhi = scan_read32(bus, i, SSB_IDHIGH);
349 dev->id.coreid = (idhi & SSB_IDHIGH_CC) >> SSB_IDHIGH_CC_SHIFT;
350 dev->id.revision = (idhi & SSB_IDHIGH_RCLO);
351 dev->id.revision |= (idhi & SSB_IDHIGH_RCHI) >> SSB_IDHIGH_RCHI_SHIFT;
352 dev->id.vendor = (idhi & SSB_IDHIGH_VC) >> SSB_IDHIGH_VC_SHIFT;
353 dev->core_index = i;
354 dev->bus = bus;
355 dev->ops = bus->ops;
356
357 printk(KERN_DEBUG PFX
358 "Core %d found: %s "
359 "(cc 0x%03X, rev 0x%02X, vendor 0x%04X)\n",
360 i, ssb_core_name(dev->id.coreid),
361 dev->id.coreid, dev->id.revision, dev->id.vendor);
362
363 switch (dev->id.coreid) {
364 case SSB_DEV_80211:
365 nr_80211_cores++;
366 if (nr_80211_cores > 1) {
367 if (!we_support_multiple_80211_cores(bus)) {
368 ssb_dprintk(KERN_INFO PFX "Ignoring additional "
369 "802.11 core\n");
370 continue;
371 }
372 }
373 break;
374 case SSB_DEV_EXTIF:
375#ifdef CONFIG_SSB_DRIVER_EXTIF
376 if (bus->extif.dev) {
377 ssb_printk(KERN_WARNING PFX
378 "WARNING: Multiple EXTIFs found\n");
379 break;
380 }
381 bus->extif.dev = dev;
382#endif
383 break;
384 case SSB_DEV_CHIPCOMMON:
385 if (bus->chipco.dev) {
386 ssb_printk(KERN_WARNING PFX
387 "WARNING: Multiple ChipCommon found\n");
388 break;
389 }
390 bus->chipco.dev = dev;
391 break;
392 case SSB_DEV_MIPS:
393 case SSB_DEV_MIPS_3302:
394#ifdef CONFIG_SSB_DRIVER_MIPS
395 if (bus->mipscore.dev) {
396 ssb_printk(KERN_WARNING PFX
397 "WARNING: Multiple MIPS cores found\n");
398 break;
399 }
400 bus->mipscore.dev = dev;
401#endif
402 break;
403 case SSB_DEV_PCI:
404 case SSB_DEV_PCIE:
405#ifdef CONFIG_SSB_DRIVER_PCICORE
406 if (bus->bustype == SSB_BUSTYPE_PCI) {
407
408
409 if (dev->id.coreid == SSB_DEV_PCI) {
410 if (pci_is_pcie(bus->host_pci))
411 continue;
412 } else {
413 if (!pci_is_pcie(bus->host_pci))
414 continue;
415 }
416 }
417 if (bus->pcicore.dev) {
418 ssb_printk(KERN_WARNING PFX
419 "WARNING: Multiple PCI(E) cores found\n");
420 break;
421 }
422 bus->pcicore.dev = dev;
423#endif
424 break;
425 case SSB_DEV_ETHERNET:
426 if (bus->bustype == SSB_BUSTYPE_PCI) {
427 if (bus->host_pci->vendor == PCI_VENDOR_ID_BROADCOM &&
428 (bus->host_pci->device & 0xFF00) == 0x4300) {
429
430
431 continue;
432 }
433 }
434 break;
435 default:
436 break;
437 }
438
439 dev_i++;
440 }
441 bus->nr_devices = dev_i;
442
443 err = 0;
444out:
445 return err;
446err_unmap:
447 ssb_iounmap(bus);
448 goto out;
449}
450
