bcma: add bcma_core_pci_fixcfg()
This code is based on code from pcicore_fixcfg() in brcmsmac. This patch is part of the move of pci specific code from brcmsmac to bcma. Signed-off-by: Hauke Mehrtens <hauke@hauke-m.de> Tested-by: Arend van Spriel <arend@broadcom.com> Signed-off-by: John W. Linville <linville@tuxdriver.com>
This commit is contained in:
parent
29f6b3d823
commit
ec00f37321
|
@ -168,12 +168,31 @@ static void bcma_pcicore_serdes_workaround(struct bcma_drv_pci *pc)
|
|||
tmp & ~BCMA_CORE_PCI_PLL_CTRL_FREQDET_EN);
|
||||
}
|
||||
|
||||
static void bcma_core_pci_fixcfg(struct bcma_drv_pci *pc)
|
||||
{
|
||||
struct bcma_device *core = pc->core;
|
||||
u16 val16, core_index;
|
||||
uint regoff;
|
||||
|
||||
regoff = BCMA_CORE_PCI_SPROM(BCMA_CORE_PCI_SPROM_PI_OFFSET);
|
||||
core_index = (u16)core->core_index;
|
||||
|
||||
val16 = pcicore_read16(pc, regoff);
|
||||
if (((val16 & BCMA_CORE_PCI_SPROM_PI_MASK) >> BCMA_CORE_PCI_SPROM_PI_SHIFT)
|
||||
!= core_index) {
|
||||
val16 = (core_index << BCMA_CORE_PCI_SPROM_PI_SHIFT) |
|
||||
(val16 & ~BCMA_CORE_PCI_SPROM_PI_MASK);
|
||||
pcicore_write16(pc, regoff, val16);
|
||||
}
|
||||
}
|
||||
|
||||
/**************************************************
|
||||
* Init.
|
||||
**************************************************/
|
||||
|
||||
static void __devinit bcma_core_pci_clientmode_init(struct bcma_drv_pci *pc)
|
||||
{
|
||||
bcma_core_pci_fixcfg(pc);
|
||||
bcma_pcicore_serdes_workaround(pc);
|
||||
}
|
||||
|
||||
|
|
|
@ -87,6 +87,9 @@ struct pci_dev;
|
|||
#define BCMA_CORE_PCI_PCICFG2 0x0600 /* PCI config space 2 (rev >= 8) */
|
||||
#define BCMA_CORE_PCI_PCICFG3 0x0700 /* PCI config space 3 (rev >= 8) */
|
||||
#define BCMA_CORE_PCI_SPROM(wordoffset) (0x0800 + ((wordoffset) * 2)) /* SPROM shadow area (72 bytes) */
|
||||
#define BCMA_CORE_PCI_SPROM_PI_OFFSET 0 /* first word */
|
||||
#define BCMA_CORE_PCI_SPROM_PI_MASK 0xf000 /* bit 15:12 */
|
||||
#define BCMA_CORE_PCI_SPROM_PI_SHIFT 12 /* bit 15:12 */
|
||||
|
||||
/* SBtoPCIx */
|
||||
#define BCMA_CORE_PCI_SBTOPCI_MEM 0x00000000
|
||||
|
@ -202,7 +205,9 @@ struct bcma_drv_pci {
|
|||
};
|
||||
|
||||
/* Register access */
|
||||
#define pcicore_read16(pc, offset) bcma_read16((pc)->core, offset)
|
||||
#define pcicore_read32(pc, offset) bcma_read32((pc)->core, offset)
|
||||
#define pcicore_write16(pc, offset, val) bcma_write16((pc)->core, offset, val)
|
||||
#define pcicore_write32(pc, offset, val) bcma_write32((pc)->core, offset, val)
|
||||
|
||||
extern void __devinit bcma_core_pci_init(struct bcma_drv_pci *pc);
|
||||
|
|
Loading…
Reference in New Issue