1 /* 2 * Broadcom specific AMBA 3 * PCI Core 4 * 5 * Copyright 2005, 2011, Broadcom Corporation 6 * Copyright 2006, 2007, Michael Buesch <m@bues.ch> 7 * Copyright 2011, 2012, Hauke Mehrtens <hauke@hauke-m.de> 8 * 9 * Licensed under the GNU/GPL. See COPYING for details. 10 */ 11 12 #include "bcma_private.h" 13 #include <linux/export.h> 14 #include <linux/bcma/bcma.h> 15 16 /************************************************** 17 * R/W ops. 18 **************************************************/ 19 20 u32 bcma_pcie_read(struct bcma_drv_pci *pc, u32 address) 21 { 22 pcicore_write32(pc, BCMA_CORE_PCI_PCIEIND_ADDR, address); 23 pcicore_read32(pc, BCMA_CORE_PCI_PCIEIND_ADDR); 24 return pcicore_read32(pc, BCMA_CORE_PCI_PCIEIND_DATA); 25 } 26 27 static void bcma_pcie_write(struct bcma_drv_pci *pc, u32 address, u32 data) 28 { 29 pcicore_write32(pc, BCMA_CORE_PCI_PCIEIND_ADDR, address); 30 pcicore_read32(pc, BCMA_CORE_PCI_PCIEIND_ADDR); 31 pcicore_write32(pc, BCMA_CORE_PCI_PCIEIND_DATA, data); 32 } 33 34 static void bcma_pcie_mdio_set_phy(struct bcma_drv_pci *pc, u16 phy) 35 { 36 u32 v; 37 int i; 38 39 v = BCMA_CORE_PCI_MDIODATA_START; 40 v |= BCMA_CORE_PCI_MDIODATA_WRITE; 41 v |= (BCMA_CORE_PCI_MDIODATA_DEV_ADDR << 42 BCMA_CORE_PCI_MDIODATA_DEVADDR_SHF); 43 v |= (BCMA_CORE_PCI_MDIODATA_BLK_ADDR << 44 BCMA_CORE_PCI_MDIODATA_REGADDR_SHF); 45 v |= BCMA_CORE_PCI_MDIODATA_TA; 46 v |= (phy << 4); 47 pcicore_write32(pc, BCMA_CORE_PCI_MDIO_DATA, v); 48 49 udelay(10); 50 for (i = 0; i < 200; i++) { 51 v = pcicore_read32(pc, BCMA_CORE_PCI_MDIO_CONTROL); 52 if (v & BCMA_CORE_PCI_MDIOCTL_ACCESS_DONE) 53 break; 54 usleep_range(1000, 2000); 55 } 56 } 57 58 static u16 bcma_pcie_mdio_read(struct bcma_drv_pci *pc, u16 device, u8 address) 59 { 60 int max_retries = 10; 61 u16 ret = 0; 62 u32 v; 63 int i; 64 65 /* enable mdio access to SERDES */ 66 v = BCMA_CORE_PCI_MDIOCTL_PREAM_EN; 67 v |= BCMA_CORE_PCI_MDIOCTL_DIVISOR_VAL; 68 pcicore_write32(pc, BCMA_CORE_PCI_MDIO_CONTROL, v); 69 70 if (pc->core->id.rev >= 10) { 71 max_retries = 200; 72 bcma_pcie_mdio_set_phy(pc, device); 73 v = (BCMA_CORE_PCI_MDIODATA_DEV_ADDR << 74 BCMA_CORE_PCI_MDIODATA_DEVADDR_SHF); 75 v |= (address << BCMA_CORE_PCI_MDIODATA_REGADDR_SHF); 76 } else { 77 v = (device << BCMA_CORE_PCI_MDIODATA_DEVADDR_SHF_OLD); 78 v |= (address << BCMA_CORE_PCI_MDIODATA_REGADDR_SHF_OLD); 79 } 80 81 v = BCMA_CORE_PCI_MDIODATA_START; 82 v |= BCMA_CORE_PCI_MDIODATA_READ; 83 v |= BCMA_CORE_PCI_MDIODATA_TA; 84 85 pcicore_write32(pc, BCMA_CORE_PCI_MDIO_DATA, v); 86 /* Wait for the device to complete the transaction */ 87 udelay(10); 88 for (i = 0; i < max_retries; i++) { 89 v = pcicore_read32(pc, BCMA_CORE_PCI_MDIO_CONTROL); 90 if (v & BCMA_CORE_PCI_MDIOCTL_ACCESS_DONE) { 91 udelay(10); 92 ret = pcicore_read32(pc, BCMA_CORE_PCI_MDIO_DATA); 93 break; 94 } 95 usleep_range(1000, 2000); 96 } 97 pcicore_write32(pc, BCMA_CORE_PCI_MDIO_CONTROL, 0); 98 return ret; 99 } 100 101 static void bcma_pcie_mdio_write(struct bcma_drv_pci *pc, u16 device, 102 u8 address, u16 data) 103 { 104 int max_retries = 10; 105 u32 v; 106 int i; 107 108 /* enable mdio access to SERDES */ 109 v = BCMA_CORE_PCI_MDIOCTL_PREAM_EN; 110 v |= BCMA_CORE_PCI_MDIOCTL_DIVISOR_VAL; 111 pcicore_write32(pc, BCMA_CORE_PCI_MDIO_CONTROL, v); 112 113 if (pc->core->id.rev >= 10) { 114 max_retries = 200; 115 bcma_pcie_mdio_set_phy(pc, device); 116 v = (BCMA_CORE_PCI_MDIODATA_DEV_ADDR << 117 BCMA_CORE_PCI_MDIODATA_DEVADDR_SHF); 118 v |= (address << BCMA_CORE_PCI_MDIODATA_REGADDR_SHF); 119 } else { 120 v = (device << BCMA_CORE_PCI_MDIODATA_DEVADDR_SHF_OLD); 121 v |= (address << BCMA_CORE_PCI_MDIODATA_REGADDR_SHF_OLD); 122 } 123 124 v = BCMA_CORE_PCI_MDIODATA_START; 125 v |= BCMA_CORE_PCI_MDIODATA_WRITE; 126 v |= BCMA_CORE_PCI_MDIODATA_TA; 127 v |= data; 128 pcicore_write32(pc, BCMA_CORE_PCI_MDIO_DATA, v); 129 /* Wait for the device to complete the transaction */ 130 udelay(10); 131 for (i = 0; i < max_retries; i++) { 132 v = pcicore_read32(pc, BCMA_CORE_PCI_MDIO_CONTROL); 133 if (v & BCMA_CORE_PCI_MDIOCTL_ACCESS_DONE) 134 break; 135 usleep_range(1000, 2000); 136 } 137 pcicore_write32(pc, BCMA_CORE_PCI_MDIO_CONTROL, 0); 138 } 139 140 static u16 bcma_pcie_mdio_writeread(struct bcma_drv_pci *pc, u16 device, 141 u8 address, u16 data) 142 { 143 bcma_pcie_mdio_write(pc, device, address, data); 144 return bcma_pcie_mdio_read(pc, device, address); 145 } 146 147 /************************************************** 148 * Early init. 149 **************************************************/ 150 151 static void bcma_core_pci_fixcfg(struct bcma_drv_pci *pc) 152 { 153 struct bcma_device *core = pc->core; 154 u16 val16, core_index; 155 uint regoff; 156 157 regoff = BCMA_CORE_PCI_SPROM(BCMA_CORE_PCI_SPROM_PI_OFFSET); 158 core_index = (u16)core->core_index; 159 160 val16 = pcicore_read16(pc, regoff); 161 if (((val16 & BCMA_CORE_PCI_SPROM_PI_MASK) >> BCMA_CORE_PCI_SPROM_PI_SHIFT) 162 != core_index) { 163 val16 = (core_index << BCMA_CORE_PCI_SPROM_PI_SHIFT) | 164 (val16 & ~BCMA_CORE_PCI_SPROM_PI_MASK); 165 pcicore_write16(pc, regoff, val16); 166 } 167 } 168 169 /* 170 * Apply some early fixes required before accessing SPROM. 171 * See also si_pci_fixcfg. 172 */ 173 void bcma_core_pci_early_init(struct bcma_drv_pci *pc) 174 { 175 if (pc->early_setup_done) 176 return; 177 178 pc->hostmode = bcma_core_pci_is_in_hostmode(pc); 179 if (pc->hostmode) 180 goto out; 181 182 bcma_core_pci_fixcfg(pc); 183 184 out: 185 pc->early_setup_done = true; 186 } 187 188 /************************************************** 189 * Workarounds. 190 **************************************************/ 191 192 static u8 bcma_pcicore_polarity_workaround(struct bcma_drv_pci *pc) 193 { 194 u32 tmp; 195 196 tmp = bcma_pcie_read(pc, BCMA_CORE_PCI_PLP_STATUSREG); 197 if (tmp & BCMA_CORE_PCI_PLP_POLARITYINV_STAT) 198 return BCMA_CORE_PCI_SERDES_RX_CTRL_FORCE | 199 BCMA_CORE_PCI_SERDES_RX_CTRL_POLARITY; 200 else 201 return BCMA_CORE_PCI_SERDES_RX_CTRL_FORCE; 202 } 203 204 static void bcma_pcicore_serdes_workaround(struct bcma_drv_pci *pc) 205 { 206 u16 tmp; 207 208 bcma_pcie_mdio_write(pc, BCMA_CORE_PCI_MDIODATA_DEV_RX, 209 BCMA_CORE_PCI_SERDES_RX_CTRL, 210 bcma_pcicore_polarity_workaround(pc)); 211 tmp = bcma_pcie_mdio_read(pc, BCMA_CORE_PCI_MDIODATA_DEV_PLL, 212 BCMA_CORE_PCI_SERDES_PLL_CTRL); 213 if (tmp & BCMA_CORE_PCI_PLL_CTRL_FREQDET_EN) 214 bcma_pcie_mdio_write(pc, BCMA_CORE_PCI_MDIODATA_DEV_PLL, 215 BCMA_CORE_PCI_SERDES_PLL_CTRL, 216 tmp & ~BCMA_CORE_PCI_PLL_CTRL_FREQDET_EN); 217 } 218 219 /* Fix MISC config to allow coming out of L2/L3-Ready state w/o PRST */ 220 /* Needs to happen when coming out of 'standby'/'hibernate' */ 221 static void bcma_core_pci_config_fixup(struct bcma_drv_pci *pc) 222 { 223 u16 val16; 224 uint regoff; 225 226 regoff = BCMA_CORE_PCI_SPROM(BCMA_CORE_PCI_SPROM_MISC_CONFIG); 227 228 val16 = pcicore_read16(pc, regoff); 229 230 if (!(val16 & BCMA_CORE_PCI_SPROM_L23READY_EXIT_NOPERST)) { 231 val16 |= BCMA_CORE_PCI_SPROM_L23READY_EXIT_NOPERST; 232 pcicore_write16(pc, regoff, val16); 233 } 234 } 235 236 /************************************************** 237 * Init. 238 **************************************************/ 239 240 static void bcma_core_pci_clientmode_init(struct bcma_drv_pci *pc) 241 { 242 bcma_pcicore_serdes_workaround(pc); 243 bcma_core_pci_config_fixup(pc); 244 } 245 246 void bcma_core_pci_init(struct bcma_drv_pci *pc) 247 { 248 if (pc->setup_done) 249 return; 250 251 bcma_core_pci_early_init(pc); 252 253 if (pc->hostmode) 254 bcma_core_pci_hostmode_init(pc); 255 else 256 bcma_core_pci_clientmode_init(pc); 257 } 258 259 void bcma_core_pci_power_save(struct bcma_bus *bus, bool up) 260 { 261 struct bcma_drv_pci *pc; 262 u16 data; 263 264 if (bus->hosttype != BCMA_HOSTTYPE_PCI) 265 return; 266 267 pc = &bus->drv_pci[0]; 268 269 if (pc->core->id.rev >= 15 && pc->core->id.rev <= 20) { 270 data = up ? 0x74 : 0x7C; 271 bcma_pcie_mdio_writeread(pc, BCMA_CORE_PCI_MDIO_BLK1, 272 BCMA_CORE_PCI_MDIO_BLK1_MGMT1, 0x7F64); 273 bcma_pcie_mdio_writeread(pc, BCMA_CORE_PCI_MDIO_BLK1, 274 BCMA_CORE_PCI_MDIO_BLK1_MGMT3, data); 275 } else if (pc->core->id.rev >= 21 && pc->core->id.rev <= 22) { 276 data = up ? 0x75 : 0x7D; 277 bcma_pcie_mdio_writeread(pc, BCMA_CORE_PCI_MDIO_BLK1, 278 BCMA_CORE_PCI_MDIO_BLK1_MGMT1, 0x7E65); 279 bcma_pcie_mdio_writeread(pc, BCMA_CORE_PCI_MDIO_BLK1, 280 BCMA_CORE_PCI_MDIO_BLK1_MGMT3, data); 281 } 282 } 283 EXPORT_SYMBOL_GPL(bcma_core_pci_power_save); 284 285 int bcma_core_pci_irq_ctl(struct bcma_drv_pci *pc, struct bcma_device *core, 286 bool enable) 287 { 288 struct pci_dev *pdev; 289 u32 coremask, tmp; 290 int err = 0; 291 292 if (!pc || core->bus->hosttype != BCMA_HOSTTYPE_PCI) { 293 /* This bcma device is not on a PCI host-bus. So the IRQs are 294 * not routed through the PCI core. 295 * So we must not enable routing through the PCI core. */ 296 goto out; 297 } 298 299 pdev = pc->core->bus->host_pci; 300 301 err = pci_read_config_dword(pdev, BCMA_PCI_IRQMASK, &tmp); 302 if (err) 303 goto out; 304 305 coremask = BIT(core->core_index) << 8; 306 if (enable) 307 tmp |= coremask; 308 else 309 tmp &= ~coremask; 310 311 err = pci_write_config_dword(pdev, BCMA_PCI_IRQMASK, tmp); 312 313 out: 314 return err; 315 } 316 EXPORT_SYMBOL_GPL(bcma_core_pci_irq_ctl); 317 318 static void bcma_core_pci_extend_L1timer(struct bcma_drv_pci *pc, bool extend) 319 { 320 u32 w; 321 322 w = bcma_pcie_read(pc, BCMA_CORE_PCI_DLLP_PMTHRESHREG); 323 if (extend) 324 w |= BCMA_CORE_PCI_ASPMTIMER_EXTEND; 325 else 326 w &= ~BCMA_CORE_PCI_ASPMTIMER_EXTEND; 327 bcma_pcie_write(pc, BCMA_CORE_PCI_DLLP_PMTHRESHREG, w); 328 bcma_pcie_read(pc, BCMA_CORE_PCI_DLLP_PMTHRESHREG); 329 } 330 331 void bcma_core_pci_up(struct bcma_bus *bus) 332 { 333 struct bcma_drv_pci *pc; 334 335 if (bus->hosttype != BCMA_HOSTTYPE_PCI) 336 return; 337 338 pc = &bus->drv_pci[0]; 339 340 bcma_core_pci_extend_L1timer(pc, true); 341 } 342 EXPORT_SYMBOL_GPL(bcma_core_pci_up); 343 344 void bcma_core_pci_down(struct bcma_bus *bus) 345 { 346 struct bcma_drv_pci *pc; 347 348 if (bus->hosttype != BCMA_HOSTTYPE_PCI) 349 return; 350 351 pc = &bus->drv_pci[0]; 352 353 bcma_core_pci_extend_L1timer(pc, false); 354 } 355 EXPORT_SYMBOL_GPL(bcma_core_pci_down); 356