| 1 | |
| 2 | * Sonics Silicon Backplane
|
| 3 | * Broadcom ChipCommon core driver
|
| 4 | *
|
| 5 | * Copyright 2005, Broadcom Corporation
|
| 6 | * Copyright 2006, 2007, Michael Buesch <[email protected]>
|
| 7 | * Copyright 2012, Hauke Mehrtens <[email protected]>
|
| 8 | *
|
| 9 | * Licensed under the GNU/GPL. See COPYING for details.
|
| 10 |
|
| 11 |
|
| 12 | #include "ssb_private.h"
|
| 13 |
|
| 14 | #include <linux/ssb/ssb.h>
|
| 15 | #include <linux/ssb/ssb_regs.h>
|
| 16 | #include <linux/export.h>
|
| 17 | #include <linux/pci.h>
|
| 18 | #include <linux/bcm47xx_wdt.h>
|
| 19 |
|
| 20 |
|
| 21 |
|
| 22 | enum ssb_clksrc {
|
| 23 |
|
| 24 | SSB_CHIPCO_CLKSRC_PCI,
|
| 25 |
|
| 26 | SSB_CHIPCO_CLKSRC_XTALOS,
|
| 27 |
|
| 28 | SSB_CHIPCO_CLKSRC_LOPWROS,
|
| 29 | };
|
| 30 |
|
| 31 |
|
| 32 | static inline u32 chipco_write32_masked(struct ssb_chipcommon *cc, u16 offset,
|
| 33 | u32 mask, u32 value)
|
| 34 | {
|
| 35 | value &= mask;
|
| 36 | value |= chipco_read32(cc, offset) & ~mask;
|
| 37 | chipco_write32(cc, offset, value);
|
| 38 |
|
| 39 | return value;
|
| 40 | }
|
| 41 |
|
| 42 | void ssb_chipco_set_clockmode(struct ssb_chipcommon *cc,
|
| 43 | enum ssb_clkmode mode)
|
| 44 | {
|
| 45 | struct ssb_device *ccdev = cc->dev;
|
| 46 | struct ssb_bus *bus;
|
| 47 | u32 tmp;
|
| 48 |
|
| 49 | if (!ccdev)
|
| 50 | return;
|
| 51 | bus = ccdev->bus;
|
| 52 |
|
| 53 |
|
| 54 | if (ccdev->id.revision >= 10 && mode == SSB_CLKMODE_SLOW)
|
| 55 | mode = SSB_CLKMODE_DYNAMIC;
|
| 56 |
|
| 57 | if (cc->capabilities & SSB_CHIPCO_CAP_PMU)
|
| 58 | return;
|
| 59 | WARN_ON(ccdev->id.revision >= 20);
|
| 60 |
|
| 61 |
|
| 62 | if (ccdev->id.revision < 6)
|
| 63 | return;
|
| 64 |
|
| 65 |
|
| 66 | if (ccdev->id.revision >= 10)
|
| 67 | return;
|
| 68 |
|
| 69 | if (!(cc->capabilities & SSB_CHIPCO_CAP_PCTL))
|
| 70 | return;
|
| 71 |
|
| 72 | switch (mode) {
|
| 73 | case SSB_CLKMODE_SLOW:
|
| 74 | tmp = chipco_read32(cc, SSB_CHIPCO_SLOWCLKCTL);
|
| 75 | tmp |= SSB_CHIPCO_SLOWCLKCTL_FSLOW;
|
| 76 | chipco_write32(cc, SSB_CHIPCO_SLOWCLKCTL, tmp);
|
| 77 | break;
|
| 78 | case SSB_CLKMODE_FAST:
|
| 79 | if (ccdev->id.revision < 10) {
|
| 80 | ssb_pci_xtal(bus, SSB_GPIO_XTAL, 1);
|
| 81 | tmp = chipco_read32(cc, SSB_CHIPCO_SLOWCLKCTL);
|
| 82 | tmp &= ~SSB_CHIPCO_SLOWCLKCTL_FSLOW;
|
| 83 | tmp |= SSB_CHIPCO_SLOWCLKCTL_IPLL;
|
| 84 | chipco_write32(cc, SSB_CHIPCO_SLOWCLKCTL, tmp);
|
| 85 | } else {
|
| 86 | chipco_write32(cc, SSB_CHIPCO_SYSCLKCTL,
|
| 87 | (chipco_read32(cc, SSB_CHIPCO_SYSCLKCTL) |
|
| 88 | SSB_CHIPCO_SYSCLKCTL_FORCEHT));
|
| 89 |
|
| 90 | }
|
| 91 | break;
|
| 92 | case SSB_CLKMODE_DYNAMIC:
|
| 93 | if (ccdev->id.revision < 10) {
|
| 94 | tmp = chipco_read32(cc, SSB_CHIPCO_SLOWCLKCTL);
|
| 95 | tmp &= ~SSB_CHIPCO_SLOWCLKCTL_FSLOW;
|
| 96 | tmp &= ~SSB_CHIPCO_SLOWCLKCTL_IPLL;
|
| 97 | tmp &= ~SSB_CHIPCO_SLOWCLKCTL_ENXTAL;
|
| 98 | if ((tmp & SSB_CHIPCO_SLOWCLKCTL_SRC) !=
|
| 99 | SSB_CHIPCO_SLOWCLKCTL_SRC_XTAL)
|
| 100 | tmp |= SSB_CHIPCO_SLOWCLKCTL_ENXTAL;
|
| 101 | chipco_write32(cc, SSB_CHIPCO_SLOWCLKCTL, tmp);
|
| 102 |
|
| 103 | |
| 104 | * "force on"
|
| 105 | if (tmp & SSB_CHIPCO_SLOWCLKCTL_ENXTAL)
|
| 106 | ssb_pci_xtal(bus, SSB_GPIO_XTAL, 0);
|
| 107 | } else {
|
| 108 | chipco_write32(cc, SSB_CHIPCO_SYSCLKCTL,
|
| 109 | (chipco_read32(cc, SSB_CHIPCO_SYSCLKCTL) &
|
| 110 | ~SSB_CHIPCO_SYSCLKCTL_FORCEHT));
|
| 111 | }
|
| 112 | break;
|
| 113 | default:
|
| 114 | WARN_ON(1);
|
| 115 | }
|
| 116 | }
|
| 117 |
|
| 118 |
|
| 119 | static enum ssb_clksrc chipco_pctl_get_slowclksrc(struct ssb_chipcommon *cc)
|
| 120 | {
|
| 121 | struct ssb_bus *bus = cc->dev->bus;
|
| 122 | u32 tmp;
|
| 123 |
|
| 124 | if (cc->dev->id.revision < 6) {
|
| 125 | if (bus->bustype == SSB_BUSTYPE_SSB ||
|
| 126 | bus->bustype == SSB_BUSTYPE_PCMCIA)
|
| 127 | return SSB_CHIPCO_CLKSRC_XTALOS;
|
| 128 | if (bus->bustype == SSB_BUSTYPE_PCI) {
|
| 129 | pci_read_config_dword(bus->host_pci, SSB_GPIO_OUT, &tmp);
|
| 130 | if (tmp & 0x10)
|
| 131 | return SSB_CHIPCO_CLKSRC_PCI;
|
| 132 | return SSB_CHIPCO_CLKSRC_XTALOS;
|
| 133 | }
|
| 134 | }
|
| 135 | if (cc->dev->id.revision < 10) {
|
| 136 | tmp = chipco_read32(cc, SSB_CHIPCO_SLOWCLKCTL);
|
| 137 | tmp &= 0x7;
|
| 138 | if (tmp == 0)
|
| 139 | return SSB_CHIPCO_CLKSRC_LOPWROS;
|
| 140 | if (tmp == 1)
|
| 141 | return SSB_CHIPCO_CLKSRC_XTALOS;
|
| 142 | if (tmp == 2)
|
| 143 | return SSB_CHIPCO_CLKSRC_PCI;
|
| 144 | }
|
| 145 |
|
| 146 | return SSB_CHIPCO_CLKSRC_XTALOS;
|
| 147 | }
|
| 148 |
|
| 149 |
|
| 150 | static int chipco_pctl_clockfreqlimit(struct ssb_chipcommon *cc, int get_max)
|
| 151 | {
|
| 152 | int limit;
|
| 153 | enum ssb_clksrc clocksrc;
|
| 154 | int divisor = 1;
|
| 155 | u32 tmp;
|
| 156 |
|
| 157 | clocksrc = chipco_pctl_get_slowclksrc(cc);
|
| 158 | if (cc->dev->id.revision < 6) {
|
| 159 | switch (clocksrc) {
|
| 160 | case SSB_CHIPCO_CLKSRC_PCI:
|
| 161 | divisor = 64;
|
| 162 | break;
|
| 163 | case SSB_CHIPCO_CLKSRC_XTALOS:
|
| 164 | divisor = 32;
|
| 165 | break;
|
| 166 | default:
|
| 167 | WARN_ON(1);
|
| 168 | }
|
| 169 | } else if (cc->dev->id.revision < 10) {
|
| 170 | switch (clocksrc) {
|
| 171 | case SSB_CHIPCO_CLKSRC_LOPWROS:
|
| 172 | break;
|
| 173 | case SSB_CHIPCO_CLKSRC_XTALOS:
|
| 174 | case SSB_CHIPCO_CLKSRC_PCI:
|
| 175 | tmp = chipco_read32(cc, SSB_CHIPCO_SLOWCLKCTL);
|
| 176 | divisor = (tmp >> 16) + 1;
|
| 177 | divisor *= 4;
|
| 178 | break;
|
| 179 | }
|
| 180 | } else {
|
| 181 | tmp = chipco_read32(cc, SSB_CHIPCO_SYSCLKCTL);
|
| 182 | divisor = (tmp >> 16) + 1;
|
| 183 | divisor *= 4;
|
| 184 | }
|
| 185 |
|
| 186 | switch (clocksrc) {
|
| 187 | case SSB_CHIPCO_CLKSRC_LOPWROS:
|
| 188 | if (get_max)
|
| 189 | limit = 43000;
|
| 190 | else
|
| 191 | limit = 25000;
|
| 192 | break;
|
| 193 | case SSB_CHIPCO_CLKSRC_XTALOS:
|
| 194 | if (get_max)
|
| 195 | limit = 20200000;
|
| 196 | else
|
| 197 | limit = 19800000;
|
| 198 | break;
|
| 199 | case SSB_CHIPCO_CLKSRC_PCI:
|
| 200 | if (get_max)
|
| 201 | limit = 34000000;
|
| 202 | else
|
| 203 | limit = 25000000;
|
| 204 | break;
|
| 205 | }
|
| 206 | limit /= divisor;
|
| 207 |
|
| 208 | return limit;
|
| 209 | }
|
| 210 |
|
| 211 | static void chipco_powercontrol_init(struct ssb_chipcommon *cc)
|
| 212 | {
|
| 213 | struct ssb_bus *bus = cc->dev->bus;
|
| 214 |
|
| 215 | if (bus->chip_id == 0x4321) {
|
| 216 | if (bus->chip_rev == 0)
|
| 217 | chipco_write32(cc, SSB_CHIPCO_CHIPCTL, 0x3A4);
|
| 218 | else if (bus->chip_rev == 1)
|
| 219 | chipco_write32(cc, SSB_CHIPCO_CHIPCTL, 0xA4);
|
| 220 | }
|
| 221 |
|
| 222 | if (!(cc->capabilities & SSB_CHIPCO_CAP_PCTL))
|
| 223 | return;
|
| 224 |
|
| 225 | if (cc->dev->id.revision >= 10) {
|
| 226 |
|
| 227 | chipco_write32(cc, SSB_CHIPCO_SYSCLKCTL,
|
| 228 | (chipco_read32(cc, SSB_CHIPCO_SYSCLKCTL) &
|
| 229 | 0x0000FFFF) | 0x00040000);
|
| 230 | } else {
|
| 231 | int maxfreq;
|
| 232 |
|
| 233 | maxfreq = chipco_pctl_clockfreqlimit(cc, 1);
|
| 234 | chipco_write32(cc, SSB_CHIPCO_PLLONDELAY,
|
| 235 | (maxfreq * 150 + 999999) / 1000000);
|
| 236 | chipco_write32(cc, SSB_CHIPCO_FREFSELDELAY,
|
| 237 | (maxfreq * 15 + 999999) / 1000000);
|
| 238 | }
|
| 239 | }
|
| 240 |
|
| 241 |
|
| 242 | static u16 pmu_fast_powerup_delay(struct ssb_chipcommon *cc)
|
| 243 | {
|
| 244 | struct ssb_bus *bus = cc->dev->bus;
|
| 245 |
|
| 246 | switch (bus->chip_id) {
|
| 247 | case 0x4312:
|
| 248 | case 0x4322:
|
| 249 | case 0x4328:
|
| 250 | return 7000;
|
| 251 | case 0x4325:
|
| 252 |
|
| 253 | default:
|
| 254 | return 15000;
|
| 255 | }
|
| 256 | }
|
| 257 |
|
| 258 |
|
| 259 | static void calc_fast_powerup_delay(struct ssb_chipcommon *cc)
|
| 260 | {
|
| 261 | struct ssb_bus *bus = cc->dev->bus;
|
| 262 | int minfreq;
|
| 263 | unsigned int tmp;
|
| 264 | u32 pll_on_delay;
|
| 265 |
|
| 266 | if (bus->bustype != SSB_BUSTYPE_PCI)
|
| 267 | return;
|
| 268 |
|
| 269 | if (cc->capabilities & SSB_CHIPCO_CAP_PMU) {
|
| 270 | cc->fast_pwrup_delay = pmu_fast_powerup_delay(cc);
|
| 271 | return;
|
| 272 | }
|
| 273 |
|
| 274 | if (!(cc->capabilities & SSB_CHIPCO_CAP_PCTL))
|
| 275 | return;
|
| 276 |
|
| 277 | minfreq = chipco_pctl_clockfreqlimit(cc, 0);
|
| 278 | pll_on_delay = chipco_read32(cc, SSB_CHIPCO_PLLONDELAY);
|
| 279 | tmp = (((pll_on_delay + 2) * 1000000) + (minfreq - 1)) / minfreq;
|
| 280 | WARN_ON(tmp & ~0xFFFF);
|
| 281 |
|
| 282 | cc->fast_pwrup_delay = tmp;
|
| 283 | }
|
| 284 |
|
| 285 | static u32 ssb_chipco_alp_clock(struct ssb_chipcommon *cc)
|
| 286 | {
|
| 287 | if (cc->capabilities & SSB_CHIPCO_CAP_PMU)
|
| 288 | return ssb_pmu_get_alp_clock(cc);
|
| 289 |
|
| 290 | return 20000000;
|
| 291 | }
|
| 292 |
|
| 293 | static u32 ssb_chipco_watchdog_get_max_timer(struct ssb_chipcommon *cc)
|
| 294 | {
|
| 295 | u32 nb;
|
| 296 |
|
| 297 | if (cc->capabilities & SSB_CHIPCO_CAP_PMU) {
|
| 298 | if (cc->dev->id.revision < 26)
|
| 299 | nb = 16;
|
| 300 | else
|
| 301 | nb = (cc->dev->id.revision >= 37) ? 32 : 24;
|
| 302 | } else {
|
| 303 | nb = 28;
|
| 304 | }
|
| 305 | if (nb == 32)
|
| 306 | return 0xffffffff;
|
| 307 | else
|
| 308 | return (1 << nb) - 1;
|
| 309 | }
|
| 310 |
|
| 311 | u32 ssb_chipco_watchdog_timer_set_wdt(struct bcm47xx_wdt *wdt, u32 ticks)
|
| 312 | {
|
| 313 | struct ssb_chipcommon *cc = bcm47xx_wdt_get_drvdata(wdt);
|
| 314 |
|
| 315 | if (cc->dev->bus->bustype != SSB_BUSTYPE_SSB)
|
| 316 | return 0;
|
| 317 |
|
| 318 | return ssb_chipco_watchdog_timer_set(cc, ticks);
|
| 319 | }
|
| 320 |
|
| 321 | u32 ssb_chipco_watchdog_timer_set_ms(struct bcm47xx_wdt *wdt, u32 ms)
|
| 322 | {
|
| 323 | struct ssb_chipcommon *cc = bcm47xx_wdt_get_drvdata(wdt);
|
| 324 | u32 ticks;
|
| 325 |
|
| 326 | if (cc->dev->bus->bustype != SSB_BUSTYPE_SSB)
|
| 327 | return 0;
|
| 328 |
|
| 329 | ticks = ssb_chipco_watchdog_timer_set(cc, cc->ticks_per_ms * ms);
|
| 330 | return ticks / cc->ticks_per_ms;
|
| 331 | }
|
| 332 |
|
| 333 | static int ssb_chipco_watchdog_ticks_per_ms(struct ssb_chipcommon *cc)
|
| 334 | {
|
| 335 | struct ssb_bus *bus = cc->dev->bus;
|
| 336 |
|
| 337 | if (cc->capabilities & SSB_CHIPCO_CAP_PMU) {
|
| 338 |
|
| 339 | return 32;
|
| 340 | } else {
|
| 341 | if (cc->dev->id.revision < 18)
|
| 342 | return ssb_clockspeed(bus) / 1000;
|
| 343 | else
|
| 344 | return ssb_chipco_alp_clock(cc) / 1000;
|
| 345 | }
|
| 346 | }
|
| 347 |
|
| 348 | void ssb_chipcommon_init(struct ssb_chipcommon *cc)
|
| 349 | {
|
| 350 | if (!cc->dev)
|
| 351 | return;
|
| 352 |
|
| 353 | spin_lock_init(&cc->gpio_lock);
|
| 354 |
|
| 355 | if (cc->dev->id.revision >= 11)
|
| 356 | cc->status = chipco_read32(cc, SSB_CHIPCO_CHIPSTAT);
|
| 357 | dev_dbg(cc->dev->dev, "chipcommon status is 0x%x\n", cc->status);
|
| 358 |
|
| 359 | if (cc->dev->id.revision >= 20) {
|
| 360 | chipco_write32(cc, SSB_CHIPCO_GPIOPULLUP, 0);
|
| 361 | chipco_write32(cc, SSB_CHIPCO_GPIOPULLDOWN, 0);
|
| 362 | }
|
| 363 |
|
| 364 | ssb_pmu_init(cc);
|
| 365 | chipco_powercontrol_init(cc);
|
| 366 | ssb_chipco_set_clockmode(cc, SSB_CLKMODE_FAST);
|
| 367 | calc_fast_powerup_delay(cc);
|
| 368 |
|
| 369 | if (cc->dev->bus->bustype == SSB_BUSTYPE_SSB) {
|
| 370 | cc->ticks_per_ms = ssb_chipco_watchdog_ticks_per_ms(cc);
|
| 371 | cc->max_timer_ms = ssb_chipco_watchdog_get_max_timer(cc) / cc->ticks_per_ms;
|
| 372 | }
|
| 373 | }
|
| 374 |
|
| 375 | void ssb_chipco_suspend(struct ssb_chipcommon *cc)
|
| 376 | {
|
| 377 | if (!cc->dev)
|
| 378 | return;
|
| 379 | ssb_chipco_set_clockmode(cc, SSB_CLKMODE_SLOW);
|
| 380 | }
|
| 381 |
|
| 382 | void ssb_chipco_resume(struct ssb_chipcommon *cc)
|
| 383 | {
|
| 384 | if (!cc->dev)
|
| 385 | return;
|
| 386 | chipco_powercontrol_init(cc);
|
| 387 | ssb_chipco_set_clockmode(cc, SSB_CLKMODE_FAST);
|
| 388 | }
|
| 389 |
|
| 390 |
|
| 391 | void ssb_chipco_get_clockcpu(struct ssb_chipcommon *cc,
|
| 392 | u32 *plltype, u32 *n, u32 *m)
|
| 393 | {
|
| 394 | *n = chipco_read32(cc, SSB_CHIPCO_CLOCK_N);
|
| 395 | *plltype = (cc->capabilities & SSB_CHIPCO_CAP_PLLT);
|
| 396 | switch (*plltype) {
|
| 397 | case SSB_PLLTYPE_2:
|
| 398 | case SSB_PLLTYPE_4:
|
| 399 | case SSB_PLLTYPE_6:
|
| 400 | case SSB_PLLTYPE_7:
|
| 401 | *m = chipco_read32(cc, SSB_CHIPCO_CLOCK_MIPS);
|
| 402 | break;
|
| 403 | case SSB_PLLTYPE_3:
|
| 404 |
|
| 405 | *m = chipco_read32(cc, SSB_CHIPCO_CLOCK_M2);
|
| 406 | break;
|
| 407 | default:
|
| 408 | *m = chipco_read32(cc, SSB_CHIPCO_CLOCK_SB);
|
| 409 | break;
|
| 410 | }
|
| 411 | }
|
| 412 |
|
| 413 |
|
| 414 | void ssb_chipco_get_clockcontrol(struct ssb_chipcommon *cc,
|
| 415 | u32 *plltype, u32 *n, u32 *m)
|
| 416 | {
|
| 417 | *n = chipco_read32(cc, SSB_CHIPCO_CLOCK_N);
|
| 418 | *plltype = (cc->capabilities & SSB_CHIPCO_CAP_PLLT);
|
| 419 | switch (*plltype) {
|
| 420 | case SSB_PLLTYPE_6:
|
| 421 | *m = chipco_read32(cc, SSB_CHIPCO_CLOCK_MIPS);
|
| 422 | break;
|
| 423 | case SSB_PLLTYPE_3:
|
| 424 | if (cc->dev->bus->chip_id != 0x5365) {
|
| 425 | *m = chipco_read32(cc, SSB_CHIPCO_CLOCK_M2);
|
| 426 | break;
|
| 427 | }
|
| 428 | fallthrough;
|
| 429 | default:
|
| 430 | *m = chipco_read32(cc, SSB_CHIPCO_CLOCK_SB);
|
| 431 | }
|
| 432 | }
|
| 433 |
|
| 434 | void ssb_chipco_timing_init(struct ssb_chipcommon *cc,
|
| 435 | unsigned long ns)
|
| 436 | {
|
| 437 | struct ssb_device *dev = cc->dev;
|
| 438 | struct ssb_bus *bus = dev->bus;
|
| 439 | u32 tmp;
|
| 440 |
|
| 441 |
|
| 442 | chipco_write32(cc, SSB_CHIPCO_PROG_CFG, 0x11);
|
| 443 | tmp = DIV_ROUND_UP(10, ns) << SSB_PROG_WCNT_3_SHIFT;
|
| 444 | tmp |= DIV_ROUND_UP(40, ns) << SSB_PROG_WCNT_1_SHIFT;
|
| 445 | tmp |= DIV_ROUND_UP(240, ns);
|
| 446 | chipco_write32(cc, SSB_CHIPCO_PROG_WAITCNT, tmp);
|
| 447 |
|
| 448 |
|
| 449 | tmp = DIV_ROUND_UP(10, ns) << SSB_FLASH_WCNT_3_SHIFT;
|
| 450 | tmp |= DIV_ROUND_UP(10, ns) << SSB_FLASH_WCNT_1_SHIFT;
|
| 451 | tmp |= DIV_ROUND_UP(120, ns);
|
| 452 | if ((bus->chip_id == 0x5365) ||
|
| 453 | (dev->id.revision < 9))
|
| 454 | chipco_write32(cc, SSB_CHIPCO_FLASH_WAITCNT, tmp);
|
| 455 | if ((bus->chip_id == 0x5365) ||
|
| 456 | (dev->id.revision < 9) ||
|
| 457 | ((bus->chip_id == 0x5350) && (bus->chip_rev == 0)))
|
| 458 | chipco_write32(cc, SSB_CHIPCO_PCMCIA_MEMWAIT, tmp);
|
| 459 |
|
| 460 | if (bus->chip_id == 0x5350) {
|
| 461 |
|
| 462 | tmp = DIV_ROUND_UP(10, ns) << SSB_PROG_WCNT_3_SHIFT;
|
| 463 | tmp |= DIV_ROUND_UP(20, ns) << SSB_PROG_WCNT_2_SHIFT;
|
| 464 | tmp |= DIV_ROUND_UP(100, ns) << SSB_PROG_WCNT_1_SHIFT;
|
| 465 | tmp |= DIV_ROUND_UP(120, ns);
|
| 466 | chipco_write32(cc, SSB_CHIPCO_PROG_WAITCNT, tmp);
|
| 467 | }
|
| 468 | }
|
| 469 |
|
| 470 |
|
| 471 | u32 ssb_chipco_watchdog_timer_set(struct ssb_chipcommon *cc, u32 ticks)
|
| 472 | {
|
| 473 | u32 maxt;
|
| 474 | enum ssb_clkmode clkmode;
|
| 475 |
|
| 476 | maxt = ssb_chipco_watchdog_get_max_timer(cc);
|
| 477 | if (cc->capabilities & SSB_CHIPCO_CAP_PMU) {
|
| 478 | if (ticks == 1)
|
| 479 | ticks = 2;
|
| 480 | else if (ticks > maxt)
|
| 481 | ticks = maxt;
|
| 482 | chipco_write32(cc, SSB_CHIPCO_PMU_WATCHDOG, ticks);
|
| 483 | } else {
|
| 484 | clkmode = ticks ? SSB_CLKMODE_FAST : SSB_CLKMODE_DYNAMIC;
|
| 485 | ssb_chipco_set_clockmode(cc, clkmode);
|
| 486 | if (ticks > maxt)
|
| 487 | ticks = maxt;
|
| 488 |
|
| 489 | chipco_write32(cc, SSB_CHIPCO_WATCHDOG, ticks);
|
| 490 | }
|
| 491 | return ticks;
|
| 492 | }
|
| 493 |
|
| 494 | void ssb_chipco_irq_mask(struct ssb_chipcommon *cc, u32 mask, u32 value)
|
| 495 | {
|
| 496 | chipco_write32_masked(cc, SSB_CHIPCO_IRQMASK, mask, value);
|
| 497 | }
|
| 498 |
|
| 499 | u32 ssb_chipco_irq_status(struct ssb_chipcommon *cc, u32 mask)
|
| 500 | {
|
| 501 | return chipco_read32(cc, SSB_CHIPCO_IRQSTAT) & mask;
|
| 502 | }
|
| 503 |
|
| 504 | u32 ssb_chipco_gpio_in(struct ssb_chipcommon *cc, u32 mask)
|
| 505 | {
|
| 506 | return chipco_read32(cc, SSB_CHIPCO_GPIOIN) & mask;
|
| 507 | }
|
| 508 |
|
| 509 | u32 ssb_chipco_gpio_out(struct ssb_chipcommon *cc, u32 mask, u32 value)
|
| 510 | {
|
| 511 | unsigned long flags;
|
| 512 | u32 res = 0;
|
| 513 |
|
| 514 | spin_lock_irqsave(&cc->gpio_lock, flags);
|
| 515 | res = chipco_write32_masked(cc, SSB_CHIPCO_GPIOOUT, mask, value);
|
| 516 | spin_unlock_irqrestore(&cc->gpio_lock, flags);
|
| 517 |
|
| 518 | return res;
|
| 519 | }
|
| 520 |
|
| 521 | u32 ssb_chipco_gpio_outen(struct ssb_chipcommon *cc, u32 mask, u32 value)
|
| 522 | {
|
| 523 | unsigned long flags;
|
| 524 | u32 res = 0;
|
| 525 |
|
| 526 | spin_lock_irqsave(&cc->gpio_lock, flags);
|
| 527 | res = chipco_write32_masked(cc, SSB_CHIPCO_GPIOOUTEN, mask, value);
|
| 528 | spin_unlock_irqrestore(&cc->gpio_lock, flags);
|
| 529 |
|
| 530 | return res;
|
| 531 | }
|
| 532 |
|
| 533 | u32 ssb_chipco_gpio_control(struct ssb_chipcommon *cc, u32 mask, u32 value)
|
| 534 | {
|
| 535 | unsigned long flags;
|
| 536 | u32 res = 0;
|
| 537 |
|
| 538 | spin_lock_irqsave(&cc->gpio_lock, flags);
|
| 539 | res = chipco_write32_masked(cc, SSB_CHIPCO_GPIOCTL, mask, value);
|
| 540 | spin_unlock_irqrestore(&cc->gpio_lock, flags);
|
| 541 |
|
| 542 | return res;
|
| 543 | }
|
| 544 | EXPORT_SYMBOL(ssb_chipco_gpio_control);
|
| 545 |
|
| 546 | u32 ssb_chipco_gpio_intmask(struct ssb_chipcommon *cc, u32 mask, u32 value)
|
| 547 | {
|
| 548 | unsigned long flags;
|
| 549 | u32 res = 0;
|
| 550 |
|
| 551 | spin_lock_irqsave(&cc->gpio_lock, flags);
|
| 552 | res = chipco_write32_masked(cc, SSB_CHIPCO_GPIOIRQ, mask, value);
|
| 553 | spin_unlock_irqrestore(&cc->gpio_lock, flags);
|
| 554 |
|
| 555 | return res;
|
| 556 | }
|
| 557 |
|
| 558 | u32 ssb_chipco_gpio_polarity(struct ssb_chipcommon *cc, u32 mask, u32 value)
|
| 559 | {
|
| 560 | unsigned long flags;
|
| 561 | u32 res = 0;
|
| 562 |
|
| 563 | spin_lock_irqsave(&cc->gpio_lock, flags);
|
| 564 | res = chipco_write32_masked(cc, SSB_CHIPCO_GPIOPOL, mask, value);
|
| 565 | spin_unlock_irqrestore(&cc->gpio_lock, flags);
|
| 566 |
|
| 567 | return res;
|
| 568 | }
|
| 569 |
|
| 570 | u32 ssb_chipco_gpio_pullup(struct ssb_chipcommon *cc, u32 mask, u32 value)
|
| 571 | {
|
| 572 | unsigned long flags;
|
| 573 | u32 res = 0;
|
| 574 |
|
| 575 | if (cc->dev->id.revision < 20)
|
| 576 | return 0xffffffff;
|
| 577 |
|
| 578 | spin_lock_irqsave(&cc->gpio_lock, flags);
|
| 579 | res = chipco_write32_masked(cc, SSB_CHIPCO_GPIOPULLUP, mask, value);
|
| 580 | spin_unlock_irqrestore(&cc->gpio_lock, flags);
|
| 581 |
|
| 582 | return res;
|
| 583 | }
|
| 584 |
|
| 585 | u32 ssb_chipco_gpio_pulldown(struct ssb_chipcommon *cc, u32 mask, u32 value)
|
| 586 | {
|
| 587 | unsigned long flags;
|
| 588 | u32 res = 0;
|
| 589 |
|
| 590 | if (cc->dev->id.revision < 20)
|
| 591 | return 0xffffffff;
|
| 592 |
|
| 593 | spin_lock_irqsave(&cc->gpio_lock, flags);
|
| 594 | res = chipco_write32_masked(cc, SSB_CHIPCO_GPIOPULLDOWN, mask, value);
|
| 595 | spin_unlock_irqrestore(&cc->gpio_lock, flags);
|
| 596 |
|
| 597 | return res;
|
| 598 | }
|
| 599 |
|
| 600 | #ifdef CONFIG_SSB_SERIAL
|
| 601 | int ssb_chipco_serial_init(struct ssb_chipcommon *cc,
|
| 602 | struct ssb_serial_port *ports)
|
| 603 | {
|
| 604 | struct ssb_bus *bus = cc->dev->bus;
|
| 605 | int nr_ports = 0;
|
| 606 | u32 plltype;
|
| 607 | unsigned int irq;
|
| 608 | u32 baud_base, div;
|
| 609 | u32 i, n;
|
| 610 | unsigned int ccrev = cc->dev->id.revision;
|
| 611 |
|
| 612 | plltype = (cc->capabilities & SSB_CHIPCO_CAP_PLLT);
|
| 613 | irq = ssb_mips_irq(cc->dev);
|
| 614 |
|
| 615 | if (plltype == SSB_PLLTYPE_1) {
|
| 616 |
|
| 617 | baud_base = ssb_calc_clock_rate(plltype,
|
| 618 | chipco_read32(cc, SSB_CHIPCO_CLOCK_N),
|
| 619 | chipco_read32(cc, SSB_CHIPCO_CLOCK_M2));
|
| 620 | div = 1;
|
| 621 | } else {
|
| 622 | if (ccrev == 20) {
|
| 623 |
|
| 624 | baud_base = 25000000;
|
| 625 | div = 48;
|
| 626 |
|
| 627 | chipco_write32(cc, SSB_CHIPCO_CORECTL,
|
| 628 | chipco_read32(cc, SSB_CHIPCO_CORECTL)
|
| 629 | | SSB_CHIPCO_CORECTL_UARTCLK0);
|
| 630 | } else if ((ccrev >= 11) && (ccrev != 15)) {
|
| 631 | baud_base = ssb_chipco_alp_clock(cc);
|
| 632 | div = 1;
|
| 633 | if (ccrev >= 21) {
|
| 634 |
|
| 635 | chipco_write32(cc, SSB_CHIPCO_CORECTL,
|
| 636 | chipco_read32(cc, SSB_CHIPCO_CORECTL)
|
| 637 | & ~SSB_CHIPCO_CORECTL_UARTCLKEN);
|
| 638 | }
|
| 639 |
|
| 640 | chipco_write32(cc, SSB_CHIPCO_CORECTL,
|
| 641 | chipco_read32(cc, SSB_CHIPCO_CORECTL)
|
| 642 | | SSB_CHIPCO_CORECTL_UARTCLK0);
|
| 643 | if (ccrev >= 21) {
|
| 644 |
|
| 645 | chipco_write32(cc, SSB_CHIPCO_CORECTL,
|
| 646 | chipco_read32(cc, SSB_CHIPCO_CORECTL)
|
| 647 | | SSB_CHIPCO_CORECTL_UARTCLKEN);
|
| 648 | }
|
| 649 | } else if (ccrev >= 3) {
|
| 650 |
|
| 651 | baud_base = ssb_clockspeed(bus);
|
| 652 | div = chipco_read32(cc, SSB_CHIPCO_CLKDIV)
|
| 653 | & SSB_CHIPCO_CLKDIV_UART;
|
| 654 | } else {
|
| 655 |
|
| 656 | baud_base = 88000000;
|
| 657 | div = 48;
|
| 658 | }
|
| 659 |
|
| 660 |
|
| 661 | if ((ccrev > 0) &&
|
| 662 | !(chipco_read32(cc, SSB_CHIPCO_CORECTL) & SSB_CHIPCO_CORECTL_UARTCLK0)) {
|
| 663 | if ((cc->capabilities & SSB_CHIPCO_CAP_UARTCLK) ==
|
| 664 | SSB_CHIPCO_CAP_UARTCLK_INT) {
|
| 665 |
|
| 666 | baud_base /= div;
|
| 667 | } else {
|
| 668 |
|
| 669 | baud_base = 1843200;
|
| 670 | }
|
| 671 | }
|
| 672 | }
|
| 673 |
|
| 674 |
|
| 675 | n = (cc->capabilities & SSB_CHIPCO_CAP_NRUART);
|
| 676 | for (i = 0; i < n; i++) {
|
| 677 | void __iomem *cc_mmio;
|
| 678 | void __iomem *uart_regs;
|
| 679 |
|
| 680 | cc_mmio = cc->dev->bus->mmio + (cc->dev->core_index * SSB_CORE_SIZE);
|
| 681 | uart_regs = cc_mmio + SSB_CHIPCO_UART0_DATA;
|
| 682 |
|
| 683 | if (ccrev == 0)
|
| 684 | uart_regs += (i * 8);
|
| 685 | else
|
| 686 | uart_regs += (i * 256);
|
| 687 |
|
| 688 | nr_ports++;
|
| 689 | ports[i].regs = uart_regs;
|
| 690 | ports[i].irq = irq;
|
| 691 | ports[i].baud_base = baud_base;
|
| 692 | ports[i].reg_shift = 0;
|
| 693 | }
|
| 694 |
|
| 695 | return nr_ports;
|
| 696 | }
|
| 697 | #endif
|