Michael Buesch | 61e115a | 2007-09-18 15:12:50 -0400 | [diff] [blame] | 1 | /* |
| 2 | * Sonics Silicon Backplane |
| 3 | * Broadcom ChipCommon core driver |
| 4 | * |
| 5 | * Copyright 2005, Broadcom Corporation |
| 6 | * Copyright 2006, 2007, Michael Buesch <mb@bu3sch.de> |
| 7 | * |
| 8 | * Licensed under the GNU/GPL. See COPYING for details. |
| 9 | */ |
| 10 | |
| 11 | #include <linux/ssb/ssb.h> |
| 12 | #include <linux/ssb/ssb_regs.h> |
| 13 | #include <linux/pci.h> |
| 14 | |
| 15 | #include "ssb_private.h" |
| 16 | |
| 17 | |
| 18 | /* Clock sources */ |
| 19 | enum ssb_clksrc { |
| 20 | /* PCI clock */ |
| 21 | SSB_CHIPCO_CLKSRC_PCI, |
| 22 | /* Crystal slow clock oscillator */ |
| 23 | SSB_CHIPCO_CLKSRC_XTALOS, |
| 24 | /* Low power oscillator */ |
| 25 | SSB_CHIPCO_CLKSRC_LOPWROS, |
| 26 | }; |
| 27 | |
| 28 | |
Michael Buesch | c2bcbe6 | 2008-02-19 14:53:35 +0100 | [diff] [blame] | 29 | static inline u32 chipco_write32_masked(struct ssb_chipcommon *cc, u16 offset, |
| 30 | u32 mask, u32 value) |
Michael Buesch | 61e115a | 2007-09-18 15:12:50 -0400 | [diff] [blame] | 31 | { |
| 32 | value &= mask; |
| 33 | value |= chipco_read32(cc, offset) & ~mask; |
| 34 | chipco_write32(cc, offset, value); |
Michael Buesch | c2bcbe6 | 2008-02-19 14:53:35 +0100 | [diff] [blame] | 35 | |
| 36 | return value; |
Michael Buesch | 61e115a | 2007-09-18 15:12:50 -0400 | [diff] [blame] | 37 | } |
| 38 | |
| 39 | void ssb_chipco_set_clockmode(struct ssb_chipcommon *cc, |
| 40 | enum ssb_clkmode mode) |
| 41 | { |
| 42 | struct ssb_device *ccdev = cc->dev; |
| 43 | struct ssb_bus *bus; |
| 44 | u32 tmp; |
| 45 | |
| 46 | if (!ccdev) |
| 47 | return; |
| 48 | bus = ccdev->bus; |
| 49 | /* chipcommon cores prior to rev6 don't support dynamic clock control */ |
| 50 | if (ccdev->id.revision < 6) |
| 51 | return; |
| 52 | /* chipcommon cores rev10 are a whole new ball game */ |
| 53 | if (ccdev->id.revision >= 10) |
| 54 | return; |
| 55 | if (!(cc->capabilities & SSB_CHIPCO_CAP_PCTL)) |
| 56 | return; |
| 57 | |
| 58 | switch (mode) { |
| 59 | case SSB_CLKMODE_SLOW: |
| 60 | tmp = chipco_read32(cc, SSB_CHIPCO_SLOWCLKCTL); |
| 61 | tmp |= SSB_CHIPCO_SLOWCLKCTL_FSLOW; |
| 62 | chipco_write32(cc, SSB_CHIPCO_SLOWCLKCTL, tmp); |
| 63 | break; |
| 64 | case SSB_CLKMODE_FAST: |
| 65 | ssb_pci_xtal(bus, SSB_GPIO_XTAL, 1); /* Force crystal on */ |
| 66 | tmp = chipco_read32(cc, SSB_CHIPCO_SLOWCLKCTL); |
| 67 | tmp &= ~SSB_CHIPCO_SLOWCLKCTL_FSLOW; |
| 68 | tmp |= SSB_CHIPCO_SLOWCLKCTL_IPLL; |
| 69 | chipco_write32(cc, SSB_CHIPCO_SLOWCLKCTL, tmp); |
| 70 | break; |
| 71 | case SSB_CLKMODE_DYNAMIC: |
| 72 | tmp = chipco_read32(cc, SSB_CHIPCO_SLOWCLKCTL); |
| 73 | tmp &= ~SSB_CHIPCO_SLOWCLKCTL_FSLOW; |
| 74 | tmp &= ~SSB_CHIPCO_SLOWCLKCTL_IPLL; |
| 75 | tmp &= ~SSB_CHIPCO_SLOWCLKCTL_ENXTAL; |
| 76 | if ((tmp & SSB_CHIPCO_SLOWCLKCTL_SRC) != SSB_CHIPCO_SLOWCLKCTL_SRC_XTAL) |
| 77 | tmp |= SSB_CHIPCO_SLOWCLKCTL_ENXTAL; |
| 78 | chipco_write32(cc, SSB_CHIPCO_SLOWCLKCTL, tmp); |
| 79 | |
| 80 | /* for dynamic control, we have to release our xtal_pu "force on" */ |
| 81 | if (tmp & SSB_CHIPCO_SLOWCLKCTL_ENXTAL) |
| 82 | ssb_pci_xtal(bus, SSB_GPIO_XTAL, 0); |
| 83 | break; |
| 84 | default: |
| 85 | SSB_WARN_ON(1); |
| 86 | } |
| 87 | } |
| 88 | |
| 89 | /* Get the Slow Clock Source */ |
| 90 | static enum ssb_clksrc chipco_pctl_get_slowclksrc(struct ssb_chipcommon *cc) |
| 91 | { |
| 92 | struct ssb_bus *bus = cc->dev->bus; |
| 93 | u32 uninitialized_var(tmp); |
| 94 | |
| 95 | if (cc->dev->id.revision < 6) { |
| 96 | if (bus->bustype == SSB_BUSTYPE_SSB || |
| 97 | bus->bustype == SSB_BUSTYPE_PCMCIA) |
| 98 | return SSB_CHIPCO_CLKSRC_XTALOS; |
| 99 | if (bus->bustype == SSB_BUSTYPE_PCI) { |
| 100 | pci_read_config_dword(bus->host_pci, SSB_GPIO_OUT, &tmp); |
| 101 | if (tmp & 0x10) |
| 102 | return SSB_CHIPCO_CLKSRC_PCI; |
| 103 | return SSB_CHIPCO_CLKSRC_XTALOS; |
| 104 | } |
| 105 | } |
| 106 | if (cc->dev->id.revision < 10) { |
| 107 | tmp = chipco_read32(cc, SSB_CHIPCO_SLOWCLKCTL); |
| 108 | tmp &= 0x7; |
| 109 | if (tmp == 0) |
| 110 | return SSB_CHIPCO_CLKSRC_LOPWROS; |
| 111 | if (tmp == 1) |
| 112 | return SSB_CHIPCO_CLKSRC_XTALOS; |
| 113 | if (tmp == 2) |
| 114 | return SSB_CHIPCO_CLKSRC_PCI; |
| 115 | } |
| 116 | |
| 117 | return SSB_CHIPCO_CLKSRC_XTALOS; |
| 118 | } |
| 119 | |
| 120 | /* Get maximum or minimum (depending on get_max flag) slowclock frequency. */ |
| 121 | static int chipco_pctl_clockfreqlimit(struct ssb_chipcommon *cc, int get_max) |
| 122 | { |
| 123 | int uninitialized_var(limit); |
| 124 | enum ssb_clksrc clocksrc; |
| 125 | int divisor = 1; |
| 126 | u32 tmp; |
| 127 | |
| 128 | clocksrc = chipco_pctl_get_slowclksrc(cc); |
| 129 | if (cc->dev->id.revision < 6) { |
| 130 | switch (clocksrc) { |
| 131 | case SSB_CHIPCO_CLKSRC_PCI: |
| 132 | divisor = 64; |
| 133 | break; |
| 134 | case SSB_CHIPCO_CLKSRC_XTALOS: |
| 135 | divisor = 32; |
| 136 | break; |
| 137 | default: |
| 138 | SSB_WARN_ON(1); |
| 139 | } |
| 140 | } else if (cc->dev->id.revision < 10) { |
| 141 | switch (clocksrc) { |
| 142 | case SSB_CHIPCO_CLKSRC_LOPWROS: |
| 143 | break; |
| 144 | case SSB_CHIPCO_CLKSRC_XTALOS: |
| 145 | case SSB_CHIPCO_CLKSRC_PCI: |
| 146 | tmp = chipco_read32(cc, SSB_CHIPCO_SLOWCLKCTL); |
| 147 | divisor = (tmp >> 16) + 1; |
| 148 | divisor *= 4; |
| 149 | break; |
| 150 | } |
| 151 | } else { |
| 152 | tmp = chipco_read32(cc, SSB_CHIPCO_SYSCLKCTL); |
| 153 | divisor = (tmp >> 16) + 1; |
| 154 | divisor *= 4; |
| 155 | } |
| 156 | |
| 157 | switch (clocksrc) { |
| 158 | case SSB_CHIPCO_CLKSRC_LOPWROS: |
| 159 | if (get_max) |
| 160 | limit = 43000; |
| 161 | else |
| 162 | limit = 25000; |
| 163 | break; |
| 164 | case SSB_CHIPCO_CLKSRC_XTALOS: |
| 165 | if (get_max) |
| 166 | limit = 20200000; |
| 167 | else |
| 168 | limit = 19800000; |
| 169 | break; |
| 170 | case SSB_CHIPCO_CLKSRC_PCI: |
| 171 | if (get_max) |
| 172 | limit = 34000000; |
| 173 | else |
| 174 | limit = 25000000; |
| 175 | break; |
| 176 | } |
| 177 | limit /= divisor; |
| 178 | |
| 179 | return limit; |
| 180 | } |
| 181 | |
| 182 | static void chipco_powercontrol_init(struct ssb_chipcommon *cc) |
| 183 | { |
| 184 | struct ssb_bus *bus = cc->dev->bus; |
| 185 | |
| 186 | if (bus->chip_id == 0x4321) { |
| 187 | if (bus->chip_rev == 0) |
| 188 | chipco_write32(cc, SSB_CHIPCO_CHIPCTL, 0x3A4); |
| 189 | else if (bus->chip_rev == 1) |
| 190 | chipco_write32(cc, SSB_CHIPCO_CHIPCTL, 0xA4); |
| 191 | } |
| 192 | |
| 193 | if (!(cc->capabilities & SSB_CHIPCO_CAP_PCTL)) |
| 194 | return; |
| 195 | |
| 196 | if (cc->dev->id.revision >= 10) { |
| 197 | /* Set Idle Power clock rate to 1Mhz */ |
| 198 | chipco_write32(cc, SSB_CHIPCO_SYSCLKCTL, |
| 199 | (chipco_read32(cc, SSB_CHIPCO_SYSCLKCTL) & |
| 200 | 0x0000FFFF) | 0x00040000); |
| 201 | } else { |
| 202 | int maxfreq; |
| 203 | |
| 204 | maxfreq = chipco_pctl_clockfreqlimit(cc, 1); |
| 205 | chipco_write32(cc, SSB_CHIPCO_PLLONDELAY, |
| 206 | (maxfreq * 150 + 999999) / 1000000); |
| 207 | chipco_write32(cc, SSB_CHIPCO_FREFSELDELAY, |
| 208 | (maxfreq * 15 + 999999) / 1000000); |
| 209 | } |
| 210 | } |
| 211 | |
| 212 | static void calc_fast_powerup_delay(struct ssb_chipcommon *cc) |
| 213 | { |
| 214 | struct ssb_bus *bus = cc->dev->bus; |
| 215 | int minfreq; |
| 216 | unsigned int tmp; |
| 217 | u32 pll_on_delay; |
| 218 | |
| 219 | if (bus->bustype != SSB_BUSTYPE_PCI) |
| 220 | return; |
| 221 | if (!(cc->capabilities & SSB_CHIPCO_CAP_PCTL)) |
| 222 | return; |
| 223 | |
| 224 | minfreq = chipco_pctl_clockfreqlimit(cc, 0); |
| 225 | pll_on_delay = chipco_read32(cc, SSB_CHIPCO_PLLONDELAY); |
| 226 | tmp = (((pll_on_delay + 2) * 1000000) + (minfreq - 1)) / minfreq; |
| 227 | SSB_WARN_ON(tmp & ~0xFFFF); |
| 228 | |
| 229 | cc->fast_pwrup_delay = tmp; |
| 230 | } |
| 231 | |
| 232 | void ssb_chipcommon_init(struct ssb_chipcommon *cc) |
| 233 | { |
| 234 | if (!cc->dev) |
| 235 | return; /* We don't have a ChipCommon */ |
Michael Buesch | c970314 | 2009-02-03 19:23:18 +0100 | [diff] [blame] | 236 | ssb_pmu_init(cc); |
Michael Buesch | 61e115a | 2007-09-18 15:12:50 -0400 | [diff] [blame] | 237 | chipco_powercontrol_init(cc); |
| 238 | ssb_chipco_set_clockmode(cc, SSB_CLKMODE_FAST); |
| 239 | calc_fast_powerup_delay(cc); |
| 240 | } |
| 241 | |
Michael Buesch | 8fe2b65 | 2008-03-30 00:10:50 +0100 | [diff] [blame] | 242 | void ssb_chipco_suspend(struct ssb_chipcommon *cc) |
Michael Buesch | 61e115a | 2007-09-18 15:12:50 -0400 | [diff] [blame] | 243 | { |
| 244 | if (!cc->dev) |
| 245 | return; |
| 246 | ssb_chipco_set_clockmode(cc, SSB_CLKMODE_SLOW); |
| 247 | } |
| 248 | |
| 249 | void ssb_chipco_resume(struct ssb_chipcommon *cc) |
| 250 | { |
| 251 | if (!cc->dev) |
| 252 | return; |
| 253 | chipco_powercontrol_init(cc); |
| 254 | ssb_chipco_set_clockmode(cc, SSB_CLKMODE_FAST); |
| 255 | } |
| 256 | |
| 257 | /* Get the processor clock */ |
| 258 | void ssb_chipco_get_clockcpu(struct ssb_chipcommon *cc, |
| 259 | u32 *plltype, u32 *n, u32 *m) |
| 260 | { |
| 261 | *n = chipco_read32(cc, SSB_CHIPCO_CLOCK_N); |
| 262 | *plltype = (cc->capabilities & SSB_CHIPCO_CAP_PLLT); |
| 263 | switch (*plltype) { |
| 264 | case SSB_PLLTYPE_2: |
| 265 | case SSB_PLLTYPE_4: |
| 266 | case SSB_PLLTYPE_6: |
| 267 | case SSB_PLLTYPE_7: |
| 268 | *m = chipco_read32(cc, SSB_CHIPCO_CLOCK_MIPS); |
| 269 | break; |
| 270 | case SSB_PLLTYPE_3: |
| 271 | /* 5350 uses m2 to control mips */ |
| 272 | *m = chipco_read32(cc, SSB_CHIPCO_CLOCK_M2); |
| 273 | break; |
| 274 | default: |
| 275 | *m = chipco_read32(cc, SSB_CHIPCO_CLOCK_SB); |
| 276 | break; |
| 277 | } |
| 278 | } |
| 279 | |
| 280 | /* Get the bus clock */ |
| 281 | void ssb_chipco_get_clockcontrol(struct ssb_chipcommon *cc, |
| 282 | u32 *plltype, u32 *n, u32 *m) |
| 283 | { |
| 284 | *n = chipco_read32(cc, SSB_CHIPCO_CLOCK_N); |
| 285 | *plltype = (cc->capabilities & SSB_CHIPCO_CAP_PLLT); |
| 286 | switch (*plltype) { |
| 287 | case SSB_PLLTYPE_6: /* 100/200 or 120/240 only */ |
| 288 | *m = chipco_read32(cc, SSB_CHIPCO_CLOCK_MIPS); |
| 289 | break; |
| 290 | case SSB_PLLTYPE_3: /* 25Mhz, 2 dividers */ |
| 291 | if (cc->dev->bus->chip_id != 0x5365) { |
| 292 | *m = chipco_read32(cc, SSB_CHIPCO_CLOCK_M2); |
| 293 | break; |
| 294 | } |
| 295 | /* Fallthough */ |
| 296 | default: |
| 297 | *m = chipco_read32(cc, SSB_CHIPCO_CLOCK_SB); |
| 298 | } |
| 299 | } |
| 300 | |
| 301 | void ssb_chipco_timing_init(struct ssb_chipcommon *cc, |
| 302 | unsigned long ns) |
| 303 | { |
| 304 | struct ssb_device *dev = cc->dev; |
| 305 | struct ssb_bus *bus = dev->bus; |
| 306 | u32 tmp; |
| 307 | |
| 308 | /* set register for external IO to control LED. */ |
| 309 | chipco_write32(cc, SSB_CHIPCO_PROG_CFG, 0x11); |
| 310 | tmp = DIV_ROUND_UP(10, ns) << SSB_PROG_WCNT_3_SHIFT; /* Waitcount-3 = 10ns */ |
| 311 | tmp |= DIV_ROUND_UP(40, ns) << SSB_PROG_WCNT_1_SHIFT; /* Waitcount-1 = 40ns */ |
| 312 | tmp |= DIV_ROUND_UP(240, ns); /* Waitcount-0 = 240ns */ |
| 313 | chipco_write32(cc, SSB_CHIPCO_PROG_WAITCNT, tmp); /* 0x01020a0c for a 100Mhz clock */ |
| 314 | |
| 315 | /* Set timing for the flash */ |
| 316 | tmp = DIV_ROUND_UP(10, ns) << SSB_FLASH_WCNT_3_SHIFT; /* Waitcount-3 = 10nS */ |
| 317 | tmp |= DIV_ROUND_UP(10, ns) << SSB_FLASH_WCNT_1_SHIFT; /* Waitcount-1 = 10nS */ |
| 318 | tmp |= DIV_ROUND_UP(120, ns); /* Waitcount-0 = 120nS */ |
| 319 | if ((bus->chip_id == 0x5365) || |
| 320 | (dev->id.revision < 9)) |
| 321 | chipco_write32(cc, SSB_CHIPCO_FLASH_WAITCNT, tmp); |
| 322 | if ((bus->chip_id == 0x5365) || |
| 323 | (dev->id.revision < 9) || |
| 324 | ((bus->chip_id == 0x5350) && (bus->chip_rev == 0))) |
| 325 | chipco_write32(cc, SSB_CHIPCO_PCMCIA_MEMWAIT, tmp); |
| 326 | |
| 327 | if (bus->chip_id == 0x5350) { |
| 328 | /* Enable EXTIF */ |
| 329 | tmp = DIV_ROUND_UP(10, ns) << SSB_PROG_WCNT_3_SHIFT; /* Waitcount-3 = 10ns */ |
| 330 | tmp |= DIV_ROUND_UP(20, ns) << SSB_PROG_WCNT_2_SHIFT; /* Waitcount-2 = 20ns */ |
| 331 | tmp |= DIV_ROUND_UP(100, ns) << SSB_PROG_WCNT_1_SHIFT; /* Waitcount-1 = 100ns */ |
| 332 | tmp |= DIV_ROUND_UP(120, ns); /* Waitcount-0 = 120ns */ |
| 333 | chipco_write32(cc, SSB_CHIPCO_PROG_WAITCNT, tmp); /* 0x01020a0c for a 100Mhz clock */ |
| 334 | } |
| 335 | } |
| 336 | |
| 337 | /* Set chip watchdog reset timer to fire in 'ticks' backplane cycles */ |
Michael Buesch | 6b9bafe | 2007-09-19 18:55:12 +0200 | [diff] [blame] | 338 | void ssb_chipco_watchdog_timer_set(struct ssb_chipcommon *cc, u32 ticks) |
Michael Buesch | 61e115a | 2007-09-18 15:12:50 -0400 | [diff] [blame] | 339 | { |
| 340 | /* instant NMI */ |
| 341 | chipco_write32(cc, SSB_CHIPCO_WATCHDOG, ticks); |
| 342 | } |
| 343 | |
Aurelien Jarno | 28de57d | 2008-02-22 16:14:58 +0100 | [diff] [blame] | 344 | void ssb_chipco_irq_mask(struct ssb_chipcommon *cc, u32 mask, u32 value) |
| 345 | { |
| 346 | chipco_write32_masked(cc, SSB_CHIPCO_IRQMASK, mask, value); |
| 347 | } |
| 348 | |
| 349 | u32 ssb_chipco_irq_status(struct ssb_chipcommon *cc, u32 mask) |
| 350 | { |
| 351 | return chipco_read32(cc, SSB_CHIPCO_IRQSTAT) & mask; |
| 352 | } |
| 353 | |
Michael Buesch | 61e115a | 2007-09-18 15:12:50 -0400 | [diff] [blame] | 354 | u32 ssb_chipco_gpio_in(struct ssb_chipcommon *cc, u32 mask) |
| 355 | { |
| 356 | return chipco_read32(cc, SSB_CHIPCO_GPIOIN) & mask; |
| 357 | } |
| 358 | |
Michael Buesch | c2bcbe6 | 2008-02-19 14:53:35 +0100 | [diff] [blame] | 359 | u32 ssb_chipco_gpio_out(struct ssb_chipcommon *cc, u32 mask, u32 value) |
Michael Buesch | 61e115a | 2007-09-18 15:12:50 -0400 | [diff] [blame] | 360 | { |
Michael Buesch | c2bcbe6 | 2008-02-19 14:53:35 +0100 | [diff] [blame] | 361 | return chipco_write32_masked(cc, SSB_CHIPCO_GPIOOUT, mask, value); |
Michael Buesch | 61e115a | 2007-09-18 15:12:50 -0400 | [diff] [blame] | 362 | } |
| 363 | |
Michael Buesch | c2bcbe6 | 2008-02-19 14:53:35 +0100 | [diff] [blame] | 364 | u32 ssb_chipco_gpio_outen(struct ssb_chipcommon *cc, u32 mask, u32 value) |
Michael Buesch | 61e115a | 2007-09-18 15:12:50 -0400 | [diff] [blame] | 365 | { |
Michael Buesch | c2bcbe6 | 2008-02-19 14:53:35 +0100 | [diff] [blame] | 366 | return chipco_write32_masked(cc, SSB_CHIPCO_GPIOOUTEN, mask, value); |
Michael Buesch | 61e115a | 2007-09-18 15:12:50 -0400 | [diff] [blame] | 367 | } |
Michael Buesch | c2bcbe6 | 2008-02-19 14:53:35 +0100 | [diff] [blame] | 368 | |
| 369 | u32 ssb_chipco_gpio_control(struct ssb_chipcommon *cc, u32 mask, u32 value) |
| 370 | { |
| 371 | return chipco_write32_masked(cc, SSB_CHIPCO_GPIOCTL, mask, value); |
| 372 | } |
Michael Buesch | c2bcbe6 | 2008-02-19 14:53:35 +0100 | [diff] [blame] | 373 | |
| 374 | u32 ssb_chipco_gpio_intmask(struct ssb_chipcommon *cc, u32 mask, u32 value) |
| 375 | { |
| 376 | return chipco_write32_masked(cc, SSB_CHIPCO_GPIOIRQ, mask, value); |
| 377 | } |
Michael Buesch | c2bcbe6 | 2008-02-19 14:53:35 +0100 | [diff] [blame] | 378 | |
| 379 | u32 ssb_chipco_gpio_polarity(struct ssb_chipcommon *cc, u32 mask, u32 value) |
| 380 | { |
| 381 | return chipco_write32_masked(cc, SSB_CHIPCO_GPIOPOL, mask, value); |
| 382 | } |
Michael Buesch | 61e115a | 2007-09-18 15:12:50 -0400 | [diff] [blame] | 383 | |
| 384 | #ifdef CONFIG_SSB_SERIAL |
| 385 | int ssb_chipco_serial_init(struct ssb_chipcommon *cc, |
| 386 | struct ssb_serial_port *ports) |
| 387 | { |
| 388 | struct ssb_bus *bus = cc->dev->bus; |
| 389 | int nr_ports = 0; |
| 390 | u32 plltype; |
| 391 | unsigned int irq; |
| 392 | u32 baud_base, div; |
| 393 | u32 i, n; |
Michael Buesch | 58ff70d | 2008-02-18 21:44:39 +0100 | [diff] [blame] | 394 | unsigned int ccrev = cc->dev->id.revision; |
Michael Buesch | 61e115a | 2007-09-18 15:12:50 -0400 | [diff] [blame] | 395 | |
| 396 | plltype = (cc->capabilities & SSB_CHIPCO_CAP_PLLT); |
| 397 | irq = ssb_mips_irq(cc->dev); |
| 398 | |
| 399 | if (plltype == SSB_PLLTYPE_1) { |
| 400 | /* PLL clock */ |
| 401 | baud_base = ssb_calc_clock_rate(plltype, |
| 402 | chipco_read32(cc, SSB_CHIPCO_CLOCK_N), |
| 403 | chipco_read32(cc, SSB_CHIPCO_CLOCK_M2)); |
| 404 | div = 1; |
| 405 | } else { |
Michael Buesch | 58ff70d | 2008-02-18 21:44:39 +0100 | [diff] [blame] | 406 | if (ccrev == 20) { |
| 407 | /* BCM5354 uses constant 25MHz clock */ |
| 408 | baud_base = 25000000; |
| 409 | div = 48; |
Michael Buesch | 61e115a | 2007-09-18 15:12:50 -0400 | [diff] [blame] | 410 | /* Set the override bit so we don't divide it */ |
| 411 | chipco_write32(cc, SSB_CHIPCO_CORECTL, |
Michael Buesch | 58ff70d | 2008-02-18 21:44:39 +0100 | [diff] [blame] | 412 | chipco_read32(cc, SSB_CHIPCO_CORECTL) |
| 413 | | SSB_CHIPCO_CORECTL_UARTCLK0); |
| 414 | } else if ((ccrev >= 11) && (ccrev != 15)) { |
| 415 | /* Fixed ALP clock */ |
| 416 | baud_base = 20000000; |
| 417 | if (cc->capabilities & SSB_CHIPCO_CAP_PMU) { |
| 418 | /* FIXME: baud_base is different for devices with a PMU */ |
| 419 | SSB_WARN_ON(1); |
| 420 | } |
| 421 | div = 1; |
| 422 | if (ccrev >= 21) { |
| 423 | /* Turn off UART clock before switching clocksource. */ |
| 424 | chipco_write32(cc, SSB_CHIPCO_CORECTL, |
| 425 | chipco_read32(cc, SSB_CHIPCO_CORECTL) |
| 426 | & ~SSB_CHIPCO_CORECTL_UARTCLKEN); |
| 427 | } |
| 428 | /* Set the override bit so we don't divide it */ |
| 429 | chipco_write32(cc, SSB_CHIPCO_CORECTL, |
| 430 | chipco_read32(cc, SSB_CHIPCO_CORECTL) |
| 431 | | SSB_CHIPCO_CORECTL_UARTCLK0); |
| 432 | if (ccrev >= 21) { |
| 433 | /* Re-enable the UART clock. */ |
| 434 | chipco_write32(cc, SSB_CHIPCO_CORECTL, |
| 435 | chipco_read32(cc, SSB_CHIPCO_CORECTL) |
| 436 | | SSB_CHIPCO_CORECTL_UARTCLKEN); |
| 437 | } |
| 438 | } else if (ccrev >= 3) { |
Michael Buesch | 61e115a | 2007-09-18 15:12:50 -0400 | [diff] [blame] | 439 | /* Internal backplane clock */ |
| 440 | baud_base = ssb_clockspeed(bus); |
| 441 | div = chipco_read32(cc, SSB_CHIPCO_CLKDIV) |
| 442 | & SSB_CHIPCO_CLKDIV_UART; |
| 443 | } else { |
| 444 | /* Fixed internal backplane clock */ |
| 445 | baud_base = 88000000; |
| 446 | div = 48; |
| 447 | } |
| 448 | |
| 449 | /* Clock source depends on strapping if UartClkOverride is unset */ |
Michael Buesch | 58ff70d | 2008-02-18 21:44:39 +0100 | [diff] [blame] | 450 | if ((ccrev > 0) && |
Michael Buesch | 61e115a | 2007-09-18 15:12:50 -0400 | [diff] [blame] | 451 | !(chipco_read32(cc, SSB_CHIPCO_CORECTL) & SSB_CHIPCO_CORECTL_UARTCLK0)) { |
| 452 | if ((cc->capabilities & SSB_CHIPCO_CAP_UARTCLK) == |
| 453 | SSB_CHIPCO_CAP_UARTCLK_INT) { |
| 454 | /* Internal divided backplane clock */ |
| 455 | baud_base /= div; |
| 456 | } else { |
| 457 | /* Assume external clock of 1.8432 MHz */ |
| 458 | baud_base = 1843200; |
| 459 | } |
| 460 | } |
| 461 | } |
| 462 | |
| 463 | /* Determine the registers of the UARTs */ |
| 464 | n = (cc->capabilities & SSB_CHIPCO_CAP_NRUART); |
| 465 | for (i = 0; i < n; i++) { |
| 466 | void __iomem *cc_mmio; |
| 467 | void __iomem *uart_regs; |
| 468 | |
| 469 | cc_mmio = cc->dev->bus->mmio + (cc->dev->core_index * SSB_CORE_SIZE); |
| 470 | uart_regs = cc_mmio + SSB_CHIPCO_UART0_DATA; |
| 471 | /* Offset changed at after rev 0 */ |
Michael Buesch | 58ff70d | 2008-02-18 21:44:39 +0100 | [diff] [blame] | 472 | if (ccrev == 0) |
Michael Buesch | 61e115a | 2007-09-18 15:12:50 -0400 | [diff] [blame] | 473 | uart_regs += (i * 8); |
| 474 | else |
| 475 | uart_regs += (i * 256); |
| 476 | |
| 477 | nr_ports++; |
| 478 | ports[i].regs = uart_regs; |
| 479 | ports[i].irq = irq; |
| 480 | ports[i].baud_base = baud_base; |
| 481 | ports[i].reg_shift = 0; |
| 482 | } |
| 483 | |
| 484 | return nr_ports; |
| 485 | } |
| 486 | #endif /* CONFIG_SSB_SERIAL */ |