Blame view
drivers/bcma/scan.c
13.9 KB
8369ae33b bcma: add Broadco... |
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 |
/* * Broadcom specific AMBA * Bus scanning * * Licensed under the GNU/GPL. See COPYING for details. */ #include "scan.h" #include "bcma_private.h" #include <linux/bcma/bcma.h> #include <linux/bcma/bcma_regs.h> #include <linux/pci.h> #include <linux/io.h> #include <linux/dma-mapping.h> #include <linux/slab.h> struct bcma_device_id_name { u16 id; const char *name; }; |
82a7c2bb5 bcma: Find names ... |
22 23 |
static const struct bcma_device_id_name bcma_arm_device_names[] = { |
e1ac4b409 bcma: add trivial... |
24 |
{ BCMA_CORE_4706_MAC_GBIT_COMMON, "BCM4706 GBit MAC Common" }, |
82a7c2bb5 bcma: Find names ... |
25 26 27 28 29 30 |
{ BCMA_CORE_ARM_1176, "ARM 1176" }, { BCMA_CORE_ARM_7TDMI, "ARM 7TDMI" }, { BCMA_CORE_ARM_CM3, "ARM CM3" }, }; static const struct bcma_device_id_name bcma_bcm_device_names[] = { |
8369ae33b bcma: add Broadco... |
31 |
{ BCMA_CORE_OOB_ROUTER, "OOB Router" }, |
d2bb2b9e9 bcma: define some... |
32 33 34 |
{ BCMA_CORE_4706_CHIPCOMMON, "BCM4706 ChipCommon" }, { BCMA_CORE_4706_SOC_RAM, "BCM4706 SOC RAM" }, { BCMA_CORE_4706_MAC_GBIT, "BCM4706 GBit MAC" }, |
dc6be9f54 bcma: use NS pref... |
35 36 37 38 39 40 41 42 43 44 45 |
{ BCMA_CORE_NS_PCIEG2, "PCIe Gen 2" }, { BCMA_CORE_NS_DMA, "DMA" }, { BCMA_CORE_NS_SDIO3, "SDIO3" }, { BCMA_CORE_NS_USB20, "USB 2.0" }, { BCMA_CORE_NS_USB30, "USB 3.0" }, { BCMA_CORE_NS_A9JTAG, "ARM Cortex A9 JTAG" }, { BCMA_CORE_NS_DDR23, "Denali DDR2/DDR3 memory controller" }, { BCMA_CORE_NS_ROM, "ROM" }, { BCMA_CORE_NS_NAND, "NAND flash controller" }, { BCMA_CORE_NS_QSPI, "SPI flash controller" }, { BCMA_CORE_NS_CHIPCOMMON_B, "Chipcommon B" }, |
bb4997a1a bcma: add some mo... |
46 |
{ BCMA_CORE_ARMCA9, "ARM Cortex A9 core (ihost)" }, |
d2bb2b9e9 bcma: define some... |
47 48 |
{ BCMA_CORE_AMEMC, "AMEMC (DDR)" }, { BCMA_CORE_ALTA, "ALTA (I2S)" }, |
8369ae33b bcma: add Broadco... |
49 50 51 52 53 54 |
{ BCMA_CORE_INVALID, "Invalid" }, { BCMA_CORE_CHIPCOMMON, "ChipCommon" }, { BCMA_CORE_ILINE20, "ILine 20" }, { BCMA_CORE_SRAM, "SRAM" }, { BCMA_CORE_SDRAM, "SDRAM" }, { BCMA_CORE_PCI, "PCI" }, |
8369ae33b bcma: add Broadco... |
55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 |
{ BCMA_CORE_ETHERNET, "Fast Ethernet" }, { BCMA_CORE_V90, "V90" }, { BCMA_CORE_USB11_HOSTDEV, "USB 1.1 Hostdev" }, { BCMA_CORE_ADSL, "ADSL" }, { BCMA_CORE_ILINE100, "ILine 100" }, { BCMA_CORE_IPSEC, "IPSEC" }, { BCMA_CORE_UTOPIA, "UTOPIA" }, { BCMA_CORE_PCMCIA, "PCMCIA" }, { BCMA_CORE_INTERNAL_MEM, "Internal Memory" }, { BCMA_CORE_MEMC_SDRAM, "MEMC SDRAM" }, { BCMA_CORE_OFDM, "OFDM" }, { BCMA_CORE_EXTIF, "EXTIF" }, { BCMA_CORE_80211, "IEEE 802.11" }, { BCMA_CORE_PHY_A, "PHY A" }, { BCMA_CORE_PHY_B, "PHY B" }, { BCMA_CORE_PHY_G, "PHY G" }, |
8369ae33b bcma: add Broadco... |
71 72 73 74 75 76 77 78 79 80 81 82 83 |
{ BCMA_CORE_USB11_HOST, "USB 1.1 Host" }, { BCMA_CORE_USB11_DEV, "USB 1.1 Device" }, { BCMA_CORE_USB20_HOST, "USB 2.0 Host" }, { BCMA_CORE_USB20_DEV, "USB 2.0 Device" }, { BCMA_CORE_SDIO_HOST, "SDIO Host" }, { BCMA_CORE_ROBOSWITCH, "Roboswitch" }, { BCMA_CORE_PARA_ATA, "PATA" }, { BCMA_CORE_SATA_XORDMA, "SATA XOR-DMA" }, { BCMA_CORE_ETHERNET_GBIT, "GBit Ethernet" }, { BCMA_CORE_PCIE, "PCIe" }, { BCMA_CORE_PHY_N, "PHY N" }, { BCMA_CORE_SRAM_CTL, "SRAM Controller" }, { BCMA_CORE_MINI_MACPHY, "Mini MACPHY" }, |
8369ae33b bcma: add Broadco... |
84 85 86 87 |
{ BCMA_CORE_PHY_LP, "PHY LP" }, { BCMA_CORE_PMU, "PMU" }, { BCMA_CORE_PHY_SSN, "PHY SSN" }, { BCMA_CORE_SDIO_DEV, "SDIO Device" }, |
8369ae33b bcma: add Broadco... |
88 |
{ BCMA_CORE_PHY_HT, "PHY HT" }, |
8369ae33b bcma: add Broadco... |
89 90 91 92 93 94 95 96 97 98 |
{ BCMA_CORE_MAC_GBIT, "GBit MAC" }, { BCMA_CORE_DDR12_MEM_CTL, "DDR1/DDR2 Memory Controller" }, { BCMA_CORE_PCIE_RC, "PCIe Root Complex" }, { BCMA_CORE_OCP_OCP_BRIDGE, "OCP to OCP Bridge" }, { BCMA_CORE_SHARED_COMMON, "Common Shared" }, { BCMA_CORE_OCP_AHB_BRIDGE, "OCP to AHB Bridge" }, { BCMA_CORE_SPI_HOST, "SPI Host" }, { BCMA_CORE_I2S, "I2S" }, { BCMA_CORE_SDR_DDR1_MEM_CTL, "SDR/DDR1 Memory Controller" }, { BCMA_CORE_SHIM, "SHIM" }, |
d4988d4c7 bcma: add more co... |
99 100 |
{ BCMA_CORE_PCIE2, "PCIe Gen2" }, { BCMA_CORE_ARM_CR4, "ARM CR4" }, |
8369ae33b bcma: add Broadco... |
101 102 |
{ BCMA_CORE_DEFAULT, "Default" }, }; |
82a7c2bb5 bcma: Find names ... |
103 104 105 106 107 108 109 110 |
static const struct bcma_device_id_name bcma_mips_device_names[] = { { BCMA_CORE_MIPS, "MIPS" }, { BCMA_CORE_MIPS_3302, "MIPS 3302" }, { BCMA_CORE_MIPS_74K, "MIPS 74K" }, }; static const char *bcma_device_name(const struct bcma_device_id *id) |
8369ae33b bcma: add Broadco... |
111 |
{ |
82a7c2bb5 bcma: Find names ... |
112 113 |
const struct bcma_device_id_name *names; int size, i; |
8369ae33b bcma: add Broadco... |
114 |
|
82a7c2bb5 bcma: Find names ... |
115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 |
/* search manufacturer specific names */ switch (id->manuf) { case BCMA_MANUF_ARM: names = bcma_arm_device_names; size = ARRAY_SIZE(bcma_arm_device_names); break; case BCMA_MANUF_BCM: names = bcma_bcm_device_names; size = ARRAY_SIZE(bcma_bcm_device_names); break; case BCMA_MANUF_MIPS: names = bcma_mips_device_names; size = ARRAY_SIZE(bcma_mips_device_names); break; default: return "UNKNOWN"; |
8369ae33b bcma: add Broadco... |
131 |
} |
82a7c2bb5 bcma: Find names ... |
132 133 134 135 136 |
for (i = 0; i < size; i++) { if (names[i].id == id->id) return names[i].name; } |
8369ae33b bcma: add Broadco... |
137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 |
return "UNKNOWN"; } static u32 bcma_scan_read32(struct bcma_bus *bus, u8 current_coreidx, u16 offset) { return readl(bus->mmio + offset); } static void bcma_scan_switch_core(struct bcma_bus *bus, u32 addr) { if (bus->hosttype == BCMA_HOSTTYPE_PCI) pci_write_config_dword(bus->host_pci, BCMA_PCI_BAR0_WIN, addr); } |
0b8d6e59a bcma: mark erompt... |
152 |
static u32 bcma_erom_get_ent(struct bcma_bus *bus, u32 __iomem **eromptr) |
8369ae33b bcma: add Broadco... |
153 154 155 156 157 |
{ u32 ent = readl(*eromptr); (*eromptr)++; return ent; } |
0b8d6e59a bcma: mark erompt... |
158 |
static void bcma_erom_push_ent(u32 __iomem **eromptr) |
8369ae33b bcma: add Broadco... |
159 160 161 |
{ (*eromptr)--; } |
0b8d6e59a bcma: mark erompt... |
162 |
static s32 bcma_erom_get_ci(struct bcma_bus *bus, u32 __iomem **eromptr) |
8369ae33b bcma: add Broadco... |
163 164 165 166 167 168 169 170 |
{ u32 ent = bcma_erom_get_ent(bus, eromptr); if (!(ent & SCAN_ER_VALID)) return -ENOENT; if ((ent & SCAN_ER_TAG) != SCAN_ER_TAG_CI) return -ENOENT; return ent; } |
0b8d6e59a bcma: mark erompt... |
171 |
static bool bcma_erom_is_end(struct bcma_bus *bus, u32 __iomem **eromptr) |
8369ae33b bcma: add Broadco... |
172 173 174 175 176 |
{ u32 ent = bcma_erom_get_ent(bus, eromptr); bcma_erom_push_ent(eromptr); return (ent == (SCAN_ER_TAG_END | SCAN_ER_VALID)); } |
0b8d6e59a bcma: mark erompt... |
177 |
static bool bcma_erom_is_bridge(struct bcma_bus *bus, u32 __iomem **eromptr) |
8369ae33b bcma: add Broadco... |
178 179 180 181 182 183 184 |
{ u32 ent = bcma_erom_get_ent(bus, eromptr); bcma_erom_push_ent(eromptr); return (((ent & SCAN_ER_VALID)) && ((ent & SCAN_ER_TAGX) == SCAN_ER_TAG_ADDR) && ((ent & SCAN_ADDR_TYPE) == SCAN_ADDR_TYPE_BRIDGE)); } |
0b8d6e59a bcma: mark erompt... |
185 |
static void bcma_erom_skip_component(struct bcma_bus *bus, u32 __iomem **eromptr) |
8369ae33b bcma: add Broadco... |
186 187 188 189 190 191 192 193 194 195 196 197 |
{ u32 ent; while (1) { ent = bcma_erom_get_ent(bus, eromptr); if ((ent & SCAN_ER_VALID) && ((ent & SCAN_ER_TAG) == SCAN_ER_TAG_CI)) break; if (ent == (SCAN_ER_TAG_END | SCAN_ER_VALID)) break; } bcma_erom_push_ent(eromptr); } |
0b8d6e59a bcma: mark erompt... |
198 |
static s32 bcma_erom_get_mst_port(struct bcma_bus *bus, u32 __iomem **eromptr) |
8369ae33b bcma: add Broadco... |
199 200 201 202 203 204 205 206 |
{ u32 ent = bcma_erom_get_ent(bus, eromptr); if (!(ent & SCAN_ER_VALID)) return -ENOENT; if ((ent & SCAN_ER_TAG) != SCAN_ER_TAG_MP) return -ENOENT; return ent; } |
fd4edf197 bcma: fix handlin... |
207 |
static u32 bcma_erom_get_addr_desc(struct bcma_bus *bus, u32 __iomem **eromptr, |
8369ae33b bcma: add Broadco... |
208 209 210 211 212 213 214 215 216 217 218 |
u32 type, u8 port) { u32 addrl, addrh, sizel, sizeh = 0; u32 size; u32 ent = bcma_erom_get_ent(bus, eromptr); if ((!(ent & SCAN_ER_VALID)) || ((ent & SCAN_ER_TAGX) != SCAN_ER_TAG_ADDR) || ((ent & SCAN_ADDR_TYPE) != type) || (((ent & SCAN_ADDR_PORT) >> SCAN_ADDR_PORT_SHIFT) != port)) { bcma_erom_push_ent(eromptr); |
fd4edf197 bcma: fix handlin... |
219 |
return (u32)-EINVAL; |
8369ae33b bcma: add Broadco... |
220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 |
} addrl = ent & SCAN_ADDR_ADDR; if (ent & SCAN_ADDR_AG32) addrh = bcma_erom_get_ent(bus, eromptr); else addrh = 0; if ((ent & SCAN_ADDR_SZ) == SCAN_ADDR_SZ_SZD) { size = bcma_erom_get_ent(bus, eromptr); sizel = size & SCAN_SIZE_SZ; if (size & SCAN_SIZE_SG32) sizeh = bcma_erom_get_ent(bus, eromptr); } else sizel = SCAN_ADDR_SZ_BASE << ((ent & SCAN_ADDR_SZ) >> SCAN_ADDR_SZ_SHIFT); return addrl; } |
517f43e5a bcma: add functio... |
239 240 241 242 243 244 245 246 247 248 249 |
static struct bcma_device *bcma_find_core_by_index(struct bcma_bus *bus, u16 index) { struct bcma_device *core; list_for_each_entry(core, &bus->cores, list) { if (core->core_index == index) return core; } return NULL; } |
5f2d6171e bcma: add the cor... |
250 251 252 253 254 255 256 257 258 259 |
static struct bcma_device *bcma_find_core_reverse(struct bcma_bus *bus, u16 coreid) { struct bcma_device *core; list_for_each_entry_reverse(core, &bus->cores, list) { if (core->id.id == coreid) return core; } return NULL; } |
aaa2ced15 bcma: fix error c... |
260 |
#define IS_ERR_VALUE_U32(x) ((x) >= (u32)-MAX_ERRNO) |
982eee67d bcma: move parsin... |
261 |
static int bcma_get_next_core(struct bcma_bus *bus, u32 __iomem **eromptr, |
517f43e5a bcma: add functio... |
262 |
struct bcma_device_id *match, int core_num, |
982eee67d bcma: move parsin... |
263 264 |
struct bcma_device *core) { |
fd4edf197 bcma: fix handlin... |
265 |
u32 tmp; |
23a2f39c8 bcma: store more ... |
266 |
u8 i, j, k; |
982eee67d bcma: move parsin... |
267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 |
s32 cia, cib; u8 ports[2], wrappers[2]; /* get CIs */ cia = bcma_erom_get_ci(bus, eromptr); if (cia < 0) { bcma_erom_push_ent(eromptr); if (bcma_erom_is_end(bus, eromptr)) return -ESPIPE; return -EILSEQ; } cib = bcma_erom_get_ci(bus, eromptr); if (cib < 0) return -EILSEQ; /* parse CIs */ core->id.class = (cia & SCAN_CIA_CLASS) >> SCAN_CIA_CLASS_SHIFT; core->id.id = (cia & SCAN_CIA_ID) >> SCAN_CIA_ID_SHIFT; core->id.manuf = (cia & SCAN_CIA_MANUF) >> SCAN_CIA_MANUF_SHIFT; ports[0] = (cib & SCAN_CIB_NMP) >> SCAN_CIB_NMP_SHIFT; ports[1] = (cib & SCAN_CIB_NSP) >> SCAN_CIB_NSP_SHIFT; wrappers[0] = (cib & SCAN_CIB_NMW) >> SCAN_CIB_NMW_SHIFT; wrappers[1] = (cib & SCAN_CIB_NSW) >> SCAN_CIB_NSW_SHIFT; core->id.rev = (cib & SCAN_CIB_REV) >> SCAN_CIB_REV_SHIFT; if (((core->id.manuf == BCMA_MANUF_ARM) && (core->id.id == 0xFFF)) || (ports[1] == 0)) { bcma_erom_skip_component(bus, eromptr); return -ENXIO; } /* check if component is a core at all */ if (wrappers[0] + wrappers[1] == 0) { |
e1ac4b409 bcma: add trivial... |
301 302 303 |
/* Some specific cores don't need wrappers */ switch (core->id.id) { case BCMA_CORE_4706_MAC_GBIT_COMMON: |
1716bcf3f bcma: add support... |
304 |
case BCMA_CORE_NS_CHIPCOMMON_B: |
e1ac4b409 bcma: add trivial... |
305 306 307 308 309 310 |
/* Not used yet: case BCMA_CORE_OOB_ROUTER: */ break; default: bcma_erom_skip_component(bus, eromptr); return -ENXIO; } |
982eee67d bcma: move parsin... |
311 312 313 314 315 316 |
} if (bcma_erom_is_bridge(bus, eromptr)) { bcma_erom_skip_component(bus, eromptr); return -ENXIO; } |
517f43e5a bcma: add functio... |
317 318 319 320 321 322 323 324 325 326 327 328 329 330 |
if (bcma_find_core_by_index(bus, core_num)) { bcma_erom_skip_component(bus, eromptr); return -ENODEV; } if (match && ((match->manuf != BCMA_ANY_MANUF && match->manuf != core->id.manuf) || (match->id != BCMA_ANY_ID && match->id != core->id.id) || (match->rev != BCMA_ANY_REV && match->rev != core->id.rev) || (match->class != BCMA_ANY_CLASS && match->class != core->id.class) )) { bcma_erom_skip_component(bus, eromptr); return -ENODEV; } |
982eee67d bcma: move parsin... |
331 332 |
/* get & parse master ports */ for (i = 0; i < ports[0]; i++) { |
4e0d8cc10 bcma: signedness ... |
333 |
s32 mst_port_d = bcma_erom_get_mst_port(bus, eromptr); |
982eee67d bcma: move parsin... |
334 335 336 |
if (mst_port_d < 0) return -EILSEQ; } |
e167d9fbb bcma: scan for ex... |
337 338 339 340 |
/* First Slave Address Descriptor should be port 0: * the main register space for the core */ tmp = bcma_erom_get_addr_desc(bus, eromptr, SCAN_ADDR_TYPE_SLAVE, 0); |
aaa2ced15 bcma: fix error c... |
341 |
if (tmp == 0 || IS_ERR_VALUE_U32(tmp)) { |
e167d9fbb bcma: scan for ex... |
342 343 344 |
/* Try again to see if it is a bridge */ tmp = bcma_erom_get_addr_desc(bus, eromptr, SCAN_ADDR_TYPE_BRIDGE, 0); |
aaa2ced15 bcma: fix error c... |
345 |
if (tmp == 0 || IS_ERR_VALUE_U32(tmp)) { |
e167d9fbb bcma: scan for ex... |
346 347 |
return -EILSEQ; } else { |
3d9d8af33 bcma: use custom ... |
348 349 |
bcma_info(bus, "Bridge found "); |
e167d9fbb bcma: scan for ex... |
350 351 352 353 |
return -ENXIO; } } core->addr = tmp; |
982eee67d bcma: move parsin... |
354 |
/* get & parse slave ports */ |
23a2f39c8 bcma: store more ... |
355 |
k = 0; |
982eee67d bcma: move parsin... |
356 357 358 359 |
for (i = 0; i < ports[1]; i++) { for (j = 0; ; j++) { tmp = bcma_erom_get_addr_desc(bus, eromptr, SCAN_ADDR_TYPE_SLAVE, i); |
aaa2ced15 bcma: fix error c... |
360 |
if (IS_ERR_VALUE_U32(tmp)) { |
982eee67d bcma: move parsin... |
361 362 363 364 365 |
/* no more entries for port _i_ */ /* pr_debug("erom: slave port %d " * "has %d descriptors ", i, j); */ break; |
23a2f39c8 bcma: store more ... |
366 367 368 |
} else if (k < ARRAY_SIZE(core->addr_s)) { core->addr_s[k] = tmp; k++; |
982eee67d bcma: move parsin... |
369 370 371 372 373 374 375 376 377 |
} } } /* get & parse master wrappers */ for (i = 0; i < wrappers[0]; i++) { for (j = 0; ; j++) { tmp = bcma_erom_get_addr_desc(bus, eromptr, SCAN_ADDR_TYPE_MWRAP, i); |
aaa2ced15 bcma: fix error c... |
378 |
if (IS_ERR_VALUE_U32(tmp)) { |
982eee67d bcma: move parsin... |
379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 |
/* no more entries for port _i_ */ /* pr_debug("erom: master wrapper %d " * "has %d descriptors ", i, j); */ break; } else { if (i == 0 && j == 0) core->wrap = tmp; } } } /* get & parse slave wrappers */ for (i = 0; i < wrappers[1]; i++) { u8 hack = (ports[1] == 1) ? 0 : 1; for (j = 0; ; j++) { tmp = bcma_erom_get_addr_desc(bus, eromptr, SCAN_ADDR_TYPE_SWRAP, i + hack); |
aaa2ced15 bcma: fix error c... |
397 |
if (IS_ERR_VALUE_U32(tmp)) { |
982eee67d bcma: move parsin... |
398 399 400 401 402 403 404 405 406 407 408 |
/* no more entries for port _i_ */ /* pr_debug("erom: master wrapper %d " * has %d descriptors ", i, j); */ break; } else { if (wrappers[0] == 0 && !i && !j) core->wrap = tmp; } } } |
ecd177c21 bcma: add SOC bus |
409 410 411 412 |
if (bus->hosttype == BCMA_HOSTTYPE_SOC) { core->io_addr = ioremap_nocache(core->addr, BCMA_CORE_SIZE); if (!core->io_addr) return -ENOMEM; |
ecf47e9bb bcma: only map wr... |
413 414 415 416 417 418 419 |
if (core->wrap) { core->io_wrap = ioremap_nocache(core->wrap, BCMA_CORE_SIZE); if (!core->io_wrap) { iounmap(core->io_addr); return -ENOMEM; } |
ecd177c21 bcma: add SOC bus |
420 421 |
} } |
982eee67d bcma: move parsin... |
422 423 |
return 0; } |
799038ea9 bcma: clean bus i... |
424 |
void bcma_detect_chip(struct bcma_bus *bus) |
8369ae33b bcma: add Broadco... |
425 |
{ |
8369ae33b bcma: add Broadco... |
426 |
s32 tmp; |
f0d4724b2 bcma: log the id,... |
427 |
struct bcma_chipinfo *chipinfo = &(bus->chipinfo); |
fbf019909 bcma: print chip ... |
428 |
char chip_id[8]; |
8369ae33b bcma: add Broadco... |
429 |
|
8369ae33b bcma: add Broadco... |
430 431 432 |
bcma_scan_switch_core(bus, BCMA_ADDR_BASE); tmp = bcma_scan_read32(bus, 0, BCMA_CC_ID); |
f0d4724b2 bcma: log the id,... |
433 434 435 |
chipinfo->id = (tmp & BCMA_CC_ID_ID) >> BCMA_CC_ID_ID_SHIFT; chipinfo->rev = (tmp & BCMA_CC_ID_REV) >> BCMA_CC_ID_REV_SHIFT; chipinfo->pkg = (tmp & BCMA_CC_ID_PKG) >> BCMA_CC_ID_PKG_SHIFT; |
fbf019909 bcma: print chip ... |
436 437 438 439 440 441 |
snprintf(chip_id, ARRAY_SIZE(chip_id), (chipinfo->id > 0x9999) ? "%d" : "0x%04X", chipinfo->id); bcma_info(bus, "Found chip with id %s, rev 0x%02X and package 0x%02X ", chip_id, chipinfo->rev, chipinfo->pkg); |
67a5c29e1 bcma: move initia... |
442 443 444 445 446 447 |
} int bcma_bus_scan(struct bcma_bus *bus) { u32 erombase; u32 __iomem *eromptr, *eromend; |
517f43e5a bcma: add functio... |
448 |
int err, core_num = 0; |
67a5c29e1 bcma: move initia... |
449 |
|
c5ed1df78 bcma: use standar... |
450 451 452 |
/* Skip if bus was already scanned (e.g. during early register) */ if (bus->nr_cores) return 0; |
8369ae33b bcma: add Broadco... |
453 |
erombase = bcma_scan_read32(bus, 0, BCMA_CC_EROM); |
ecd177c21 bcma: add SOC bus |
454 455 456 457 458 459 460 |
if (bus->hosttype == BCMA_HOSTTYPE_SOC) { eromptr = ioremap_nocache(erombase, BCMA_CORE_SIZE); if (!eromptr) return -ENOMEM; } else { eromptr = bus->mmio; } |
8369ae33b bcma: add Broadco... |
461 462 463 464 465 |
eromend = eromptr + BCMA_CORE_SIZE / sizeof(u32); bcma_scan_switch_core(bus, erombase); while (eromptr < eromend) { |
5f2d6171e bcma: add the cor... |
466 |
struct bcma_device *other_core; |
8369ae33b bcma: add Broadco... |
467 |
struct bcma_device *core = kzalloc(sizeof(*core), GFP_KERNEL); |
9dbf5f55f bcma: add missing... |
468 469 470 471 |
if (!core) { err = -ENOMEM; goto out; } |
8369ae33b bcma: add Broadco... |
472 473 |
INIT_LIST_HEAD(&core->list); core->bus = bus; |
517f43e5a bcma: add functio... |
474 |
err = bcma_get_next_core(bus, &eromptr, NULL, core_num, core); |
f9721ed27 bcma: Fix mem lea... |
475 476 477 478 479 480 481 482 483 484 |
if (err < 0) { kfree(core); if (err == -ENODEV) { core_num++; continue; } else if (err == -ENXIO) { continue; } else if (err == -ESPIPE) { break; } |
9dbf5f55f bcma: add missing... |
485 |
goto out; |
f9721ed27 bcma: Fix mem lea... |
486 |
} |
8369ae33b bcma: add Broadco... |
487 |
|
517f43e5a bcma: add functio... |
488 489 |
core->core_index = core_num++; bus->nr_cores++; |
5f2d6171e bcma: add the cor... |
490 491 |
other_core = bcma_find_core_reverse(bus, core->id.id); core->core_unit = (other_core == NULL) ? 0 : other_core->core_unit + 1; |
ab54bc846 bcma: fill core d... |
492 |
bcma_prepare_core(bus, core); |
517f43e5a bcma: add functio... |
493 |
|
3d9d8af33 bcma: use custom ... |
494 495 496 497 498 |
bcma_info(bus, "Core %d found: %s (manuf 0x%03X, id 0x%03X, rev 0x%02X, class 0x%X) ", core->core_index, bcma_device_name(&core->id), core->id.manuf, core->id.id, core->id.rev, core->id.class); |
8369ae33b bcma: add Broadco... |
499 |
|
c334e25c9 bcma: add new cor... |
500 |
list_add_tail(&core->list, &bus->cores); |
8369ae33b bcma: add Broadco... |
501 |
} |
9dbf5f55f bcma: add missing... |
502 503 |
err = 0; out: |
ecd177c21 bcma: add SOC bus |
504 505 |
if (bus->hosttype == BCMA_HOSTTYPE_SOC) iounmap(eromptr); |
9dbf5f55f bcma: add missing... |
506 |
return err; |
8369ae33b bcma: add Broadco... |
507 |
} |