netfilter: fix export secctx error handling
[linux-2.6.git] / drivers / ssb / driver_chipcommon.c
blob7c031fdc8205eff8475ecbd11dc098f3beb0c584
1 /*
2 * Sonics Silicon Backplane
3 * Broadcom ChipCommon core driver
5 * Copyright 2005, Broadcom Corporation
6 * Copyright 2006, 2007, Michael Buesch <mb@bu3sch.de>
8 * Licensed under the GNU/GPL. See COPYING for details.
9 */
11 #include <linux/ssb/ssb.h>
12 #include <linux/ssb/ssb_regs.h>
13 #include <linux/pci.h>
15 #include "ssb_private.h"
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,
29 static inline u32 chipco_write32_masked(struct ssb_chipcommon *cc, u16 offset,
30 u32 mask, u32 value)
32 value &= mask;
33 value |= chipco_read32(cc, offset) & ~mask;
34 chipco_write32(cc, offset, value);
36 return value;
39 void ssb_chipco_set_clockmode(struct ssb_chipcommon *cc,
40 enum ssb_clkmode mode)
42 struct ssb_device *ccdev = cc->dev;
43 struct ssb_bus *bus;
44 u32 tmp;
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;
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);
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);
89 /* Get the Slow Clock Source */
90 static enum ssb_clksrc chipco_pctl_get_slowclksrc(struct ssb_chipcommon *cc)
92 struct ssb_bus *bus = cc->dev->bus;
93 u32 uninitialized_var(tmp);
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;
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;
117 return SSB_CHIPCO_CLKSRC_XTALOS;
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)
123 int uninitialized_var(limit);
124 enum ssb_clksrc clocksrc;
125 int divisor = 1;
126 u32 tmp;
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);
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;
151 } else {
152 tmp = chipco_read32(cc, SSB_CHIPCO_SYSCLKCTL);
153 divisor = (tmp >> 16) + 1;
154 divisor *= 4;
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;
177 limit /= divisor;
179 return limit;
182 static void chipco_powercontrol_init(struct ssb_chipcommon *cc)
184 struct ssb_bus *bus = cc->dev->bus;
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);
193 if (!(cc->capabilities & SSB_CHIPCO_CAP_PCTL))
194 return;
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;
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);
212 /* http://bcm-v4.sipsolutions.net/802.11/PmuFastPwrupDelay */
213 static u16 pmu_fast_powerup_delay(struct ssb_chipcommon *cc)
215 struct ssb_bus *bus = cc->dev->bus;
217 switch (bus->chip_id) {
218 case 0x4312:
219 case 0x4322:
220 case 0x4328:
221 return 7000;
222 case 0x4325:
223 /* TODO: */
224 default:
225 return 15000;
229 /* http://bcm-v4.sipsolutions.net/802.11/ClkctlFastPwrupDelay */
230 static void calc_fast_powerup_delay(struct ssb_chipcommon *cc)
232 struct ssb_bus *bus = cc->dev->bus;
233 int minfreq;
234 unsigned int tmp;
235 u32 pll_on_delay;
237 if (bus->bustype != SSB_BUSTYPE_PCI)
238 return;
240 if (cc->capabilities & SSB_CHIPCO_CAP_PMU) {
241 cc->fast_pwrup_delay = pmu_fast_powerup_delay(cc);
242 return;
245 if (!(cc->capabilities & SSB_CHIPCO_CAP_PCTL))
246 return;
248 minfreq = chipco_pctl_clockfreqlimit(cc, 0);
249 pll_on_delay = chipco_read32(cc, SSB_CHIPCO_PLLONDELAY);
250 tmp = (((pll_on_delay + 2) * 1000000) + (minfreq - 1)) / minfreq;
251 SSB_WARN_ON(tmp & ~0xFFFF);
253 cc->fast_pwrup_delay = tmp;
256 void ssb_chipcommon_init(struct ssb_chipcommon *cc)
258 if (!cc->dev)
259 return; /* We don't have a ChipCommon */
260 if (cc->dev->id.revision >= 11)
261 cc->status = chipco_read32(cc, SSB_CHIPCO_CHIPSTAT);
262 ssb_dprintk(KERN_INFO PFX "chipcommon status is 0x%x\n", cc->status);
263 ssb_pmu_init(cc);
264 chipco_powercontrol_init(cc);
265 ssb_chipco_set_clockmode(cc, SSB_CLKMODE_FAST);
266 calc_fast_powerup_delay(cc);
269 void ssb_chipco_suspend(struct ssb_chipcommon *cc)
271 if (!cc->dev)
272 return;
273 ssb_chipco_set_clockmode(cc, SSB_CLKMODE_SLOW);
276 void ssb_chipco_resume(struct ssb_chipcommon *cc)
278 if (!cc->dev)
279 return;
280 chipco_powercontrol_init(cc);
281 ssb_chipco_set_clockmode(cc, SSB_CLKMODE_FAST);
284 /* Get the processor clock */
285 void ssb_chipco_get_clockcpu(struct ssb_chipcommon *cc,
286 u32 *plltype, u32 *n, u32 *m)
288 *n = chipco_read32(cc, SSB_CHIPCO_CLOCK_N);
289 *plltype = (cc->capabilities & SSB_CHIPCO_CAP_PLLT);
290 switch (*plltype) {
291 case SSB_PLLTYPE_2:
292 case SSB_PLLTYPE_4:
293 case SSB_PLLTYPE_6:
294 case SSB_PLLTYPE_7:
295 *m = chipco_read32(cc, SSB_CHIPCO_CLOCK_MIPS);
296 break;
297 case SSB_PLLTYPE_3:
298 /* 5350 uses m2 to control mips */
299 *m = chipco_read32(cc, SSB_CHIPCO_CLOCK_M2);
300 break;
301 default:
302 *m = chipco_read32(cc, SSB_CHIPCO_CLOCK_SB);
303 break;
307 /* Get the bus clock */
308 void ssb_chipco_get_clockcontrol(struct ssb_chipcommon *cc,
309 u32 *plltype, u32 *n, u32 *m)
311 *n = chipco_read32(cc, SSB_CHIPCO_CLOCK_N);
312 *plltype = (cc->capabilities & SSB_CHIPCO_CAP_PLLT);
313 switch (*plltype) {
314 case SSB_PLLTYPE_6: /* 100/200 or 120/240 only */
315 *m = chipco_read32(cc, SSB_CHIPCO_CLOCK_MIPS);
316 break;
317 case SSB_PLLTYPE_3: /* 25Mhz, 2 dividers */
318 if (cc->dev->bus->chip_id != 0x5365) {
319 *m = chipco_read32(cc, SSB_CHIPCO_CLOCK_M2);
320 break;
322 /* Fallthough */
323 default:
324 *m = chipco_read32(cc, SSB_CHIPCO_CLOCK_SB);
328 void ssb_chipco_timing_init(struct ssb_chipcommon *cc,
329 unsigned long ns)
331 struct ssb_device *dev = cc->dev;
332 struct ssb_bus *bus = dev->bus;
333 u32 tmp;
335 /* set register for external IO to control LED. */
336 chipco_write32(cc, SSB_CHIPCO_PROG_CFG, 0x11);
337 tmp = DIV_ROUND_UP(10, ns) << SSB_PROG_WCNT_3_SHIFT; /* Waitcount-3 = 10ns */
338 tmp |= DIV_ROUND_UP(40, ns) << SSB_PROG_WCNT_1_SHIFT; /* Waitcount-1 = 40ns */
339 tmp |= DIV_ROUND_UP(240, ns); /* Waitcount-0 = 240ns */
340 chipco_write32(cc, SSB_CHIPCO_PROG_WAITCNT, tmp); /* 0x01020a0c for a 100Mhz clock */
342 /* Set timing for the flash */
343 tmp = DIV_ROUND_UP(10, ns) << SSB_FLASH_WCNT_3_SHIFT; /* Waitcount-3 = 10nS */
344 tmp |= DIV_ROUND_UP(10, ns) << SSB_FLASH_WCNT_1_SHIFT; /* Waitcount-1 = 10nS */
345 tmp |= DIV_ROUND_UP(120, ns); /* Waitcount-0 = 120nS */
346 if ((bus->chip_id == 0x5365) ||
347 (dev->id.revision < 9))
348 chipco_write32(cc, SSB_CHIPCO_FLASH_WAITCNT, tmp);
349 if ((bus->chip_id == 0x5365) ||
350 (dev->id.revision < 9) ||
351 ((bus->chip_id == 0x5350) && (bus->chip_rev == 0)))
352 chipco_write32(cc, SSB_CHIPCO_PCMCIA_MEMWAIT, tmp);
354 if (bus->chip_id == 0x5350) {
355 /* Enable EXTIF */
356 tmp = DIV_ROUND_UP(10, ns) << SSB_PROG_WCNT_3_SHIFT; /* Waitcount-3 = 10ns */
357 tmp |= DIV_ROUND_UP(20, ns) << SSB_PROG_WCNT_2_SHIFT; /* Waitcount-2 = 20ns */
358 tmp |= DIV_ROUND_UP(100, ns) << SSB_PROG_WCNT_1_SHIFT; /* Waitcount-1 = 100ns */
359 tmp |= DIV_ROUND_UP(120, ns); /* Waitcount-0 = 120ns */
360 chipco_write32(cc, SSB_CHIPCO_PROG_WAITCNT, tmp); /* 0x01020a0c for a 100Mhz clock */
364 /* Set chip watchdog reset timer to fire in 'ticks' backplane cycles */
365 void ssb_chipco_watchdog_timer_set(struct ssb_chipcommon *cc, u32 ticks)
367 /* instant NMI */
368 chipco_write32(cc, SSB_CHIPCO_WATCHDOG, ticks);
371 void ssb_chipco_irq_mask(struct ssb_chipcommon *cc, u32 mask, u32 value)
373 chipco_write32_masked(cc, SSB_CHIPCO_IRQMASK, mask, value);
376 u32 ssb_chipco_irq_status(struct ssb_chipcommon *cc, u32 mask)
378 return chipco_read32(cc, SSB_CHIPCO_IRQSTAT) & mask;
381 u32 ssb_chipco_gpio_in(struct ssb_chipcommon *cc, u32 mask)
383 return chipco_read32(cc, SSB_CHIPCO_GPIOIN) & mask;
386 u32 ssb_chipco_gpio_out(struct ssb_chipcommon *cc, u32 mask, u32 value)
388 return chipco_write32_masked(cc, SSB_CHIPCO_GPIOOUT, mask, value);
391 u32 ssb_chipco_gpio_outen(struct ssb_chipcommon *cc, u32 mask, u32 value)
393 return chipco_write32_masked(cc, SSB_CHIPCO_GPIOOUTEN, mask, value);
396 u32 ssb_chipco_gpio_control(struct ssb_chipcommon *cc, u32 mask, u32 value)
398 return chipco_write32_masked(cc, SSB_CHIPCO_GPIOCTL, mask, value);
400 EXPORT_SYMBOL(ssb_chipco_gpio_control);
402 u32 ssb_chipco_gpio_intmask(struct ssb_chipcommon *cc, u32 mask, u32 value)
404 return chipco_write32_masked(cc, SSB_CHIPCO_GPIOIRQ, mask, value);
407 u32 ssb_chipco_gpio_polarity(struct ssb_chipcommon *cc, u32 mask, u32 value)
409 return chipco_write32_masked(cc, SSB_CHIPCO_GPIOPOL, mask, value);
412 #ifdef CONFIG_SSB_SERIAL
413 int ssb_chipco_serial_init(struct ssb_chipcommon *cc,
414 struct ssb_serial_port *ports)
416 struct ssb_bus *bus = cc->dev->bus;
417 int nr_ports = 0;
418 u32 plltype;
419 unsigned int irq;
420 u32 baud_base, div;
421 u32 i, n;
422 unsigned int ccrev = cc->dev->id.revision;
424 plltype = (cc->capabilities & SSB_CHIPCO_CAP_PLLT);
425 irq = ssb_mips_irq(cc->dev);
427 if (plltype == SSB_PLLTYPE_1) {
428 /* PLL clock */
429 baud_base = ssb_calc_clock_rate(plltype,
430 chipco_read32(cc, SSB_CHIPCO_CLOCK_N),
431 chipco_read32(cc, SSB_CHIPCO_CLOCK_M2));
432 div = 1;
433 } else {
434 if (ccrev == 20) {
435 /* BCM5354 uses constant 25MHz clock */
436 baud_base = 25000000;
437 div = 48;
438 /* Set the override bit so we don't divide it */
439 chipco_write32(cc, SSB_CHIPCO_CORECTL,
440 chipco_read32(cc, SSB_CHIPCO_CORECTL)
441 | SSB_CHIPCO_CORECTL_UARTCLK0);
442 } else if ((ccrev >= 11) && (ccrev != 15)) {
443 /* Fixed ALP clock */
444 baud_base = 20000000;
445 if (cc->capabilities & SSB_CHIPCO_CAP_PMU) {
446 /* FIXME: baud_base is different for devices with a PMU */
447 SSB_WARN_ON(1);
449 div = 1;
450 if (ccrev >= 21) {
451 /* Turn off UART clock before switching clocksource. */
452 chipco_write32(cc, SSB_CHIPCO_CORECTL,
453 chipco_read32(cc, SSB_CHIPCO_CORECTL)
454 & ~SSB_CHIPCO_CORECTL_UARTCLKEN);
456 /* Set the override bit so we don't divide it */
457 chipco_write32(cc, SSB_CHIPCO_CORECTL,
458 chipco_read32(cc, SSB_CHIPCO_CORECTL)
459 | SSB_CHIPCO_CORECTL_UARTCLK0);
460 if (ccrev >= 21) {
461 /* Re-enable the UART clock. */
462 chipco_write32(cc, SSB_CHIPCO_CORECTL,
463 chipco_read32(cc, SSB_CHIPCO_CORECTL)
464 | SSB_CHIPCO_CORECTL_UARTCLKEN);
466 } else if (ccrev >= 3) {
467 /* Internal backplane clock */
468 baud_base = ssb_clockspeed(bus);
469 div = chipco_read32(cc, SSB_CHIPCO_CLKDIV)
470 & SSB_CHIPCO_CLKDIV_UART;
471 } else {
472 /* Fixed internal backplane clock */
473 baud_base = 88000000;
474 div = 48;
477 /* Clock source depends on strapping if UartClkOverride is unset */
478 if ((ccrev > 0) &&
479 !(chipco_read32(cc, SSB_CHIPCO_CORECTL) & SSB_CHIPCO_CORECTL_UARTCLK0)) {
480 if ((cc->capabilities & SSB_CHIPCO_CAP_UARTCLK) ==
481 SSB_CHIPCO_CAP_UARTCLK_INT) {
482 /* Internal divided backplane clock */
483 baud_base /= div;
484 } else {
485 /* Assume external clock of 1.8432 MHz */
486 baud_base = 1843200;
491 /* Determine the registers of the UARTs */
492 n = (cc->capabilities & SSB_CHIPCO_CAP_NRUART);
493 for (i = 0; i < n; i++) {
494 void __iomem *cc_mmio;
495 void __iomem *uart_regs;
497 cc_mmio = cc->dev->bus->mmio + (cc->dev->core_index * SSB_CORE_SIZE);
498 uart_regs = cc_mmio + SSB_CHIPCO_UART0_DATA;
499 /* Offset changed at after rev 0 */
500 if (ccrev == 0)
501 uart_regs += (i * 8);
502 else
503 uart_regs += (i * 256);
505 nr_ports++;
506 ports[i].regs = uart_regs;
507 ports[i].irq = irq;
508 ports[i].baud_base = baud_base;
509 ports[i].reg_shift = 0;
512 return nr_ports;
514 #endif /* CONFIG_SSB_SERIAL */