gpio: rcar: Fix runtime PM imbalance on error
[linux/fpc-iii.git] / drivers / ssb / driver_extif.c
blobbc275968fcc6d06a2daa38b3a941614744ddff7f
1 /*
2 * Sonics Silicon Backplane
3 * Broadcom EXTIF core driver
5 * Copyright 2005, Broadcom Corporation
6 * Copyright 2006, 2007, Michael Buesch <m@bues.ch>
7 * Copyright 2006, 2007, Felix Fietkau <nbd@openwrt.org>
8 * Copyright 2007, Aurelien Jarno <aurelien@aurel32.net>
10 * Licensed under the GNU/GPL. See COPYING for details.
13 #include "ssb_private.h"
15 #include <linux/serial.h>
16 #include <linux/serial_core.h>
17 #include <linux/serial_reg.h>
20 static inline u32 extif_read32(struct ssb_extif *extif, u16 offset)
22 return ssb_read32(extif->dev, offset);
25 static inline void extif_write32(struct ssb_extif *extif, u16 offset, u32 value)
27 ssb_write32(extif->dev, offset, value);
30 static inline u32 extif_write32_masked(struct ssb_extif *extif, u16 offset,
31 u32 mask, u32 value)
33 value &= mask;
34 value |= extif_read32(extif, offset) & ~mask;
35 extif_write32(extif, offset, value);
37 return value;
40 #ifdef CONFIG_SSB_SERIAL
41 static bool serial_exists(u8 *regs)
43 u8 save_mcr, msr = 0;
45 if (regs) {
46 save_mcr = regs[UART_MCR];
47 regs[UART_MCR] = (UART_MCR_LOOP | UART_MCR_OUT2 | UART_MCR_RTS);
48 msr = regs[UART_MSR] & (UART_MSR_DCD | UART_MSR_RI
49 | UART_MSR_CTS | UART_MSR_DSR);
50 regs[UART_MCR] = save_mcr;
52 return (msr == (UART_MSR_DCD | UART_MSR_CTS));
55 int ssb_extif_serial_init(struct ssb_extif *extif, struct ssb_serial_port *ports)
57 u32 i, nr_ports = 0;
59 /* Disable GPIO interrupt initially */
60 extif_write32(extif, SSB_EXTIF_GPIO_INTPOL, 0);
61 extif_write32(extif, SSB_EXTIF_GPIO_INTMASK, 0);
63 for (i = 0; i < 2; i++) {
64 void __iomem *uart_regs;
66 uart_regs = ioremap(SSB_EUART, 16);
67 if (uart_regs) {
68 uart_regs += (i * 8);
70 if (serial_exists(uart_regs) && ports) {
71 extif_write32(extif, SSB_EXTIF_GPIO_INTMASK, 2);
73 nr_ports++;
74 ports[i].regs = uart_regs;
75 ports[i].irq = 2;
76 ports[i].baud_base = 13500000;
77 ports[i].reg_shift = 0;
79 iounmap(uart_regs);
82 return nr_ports;
84 #endif /* CONFIG_SSB_SERIAL */
86 void ssb_extif_timing_init(struct ssb_extif *extif, unsigned long ns)
88 u32 tmp;
90 /* Initialize extif so we can get to the LEDs and external UART */
91 extif_write32(extif, SSB_EXTIF_PROG_CFG, SSB_EXTCFG_EN);
93 /* Set timing for the flash */
94 tmp = DIV_ROUND_UP(10, ns) << SSB_PROG_WCNT_3_SHIFT;
95 tmp |= DIV_ROUND_UP(40, ns) << SSB_PROG_WCNT_1_SHIFT;
96 tmp |= DIV_ROUND_UP(120, ns);
97 extif_write32(extif, SSB_EXTIF_PROG_WAITCNT, tmp);
99 /* Set programmable interface timing for external uart */
100 tmp = DIV_ROUND_UP(10, ns) << SSB_PROG_WCNT_3_SHIFT;
101 tmp |= DIV_ROUND_UP(20, ns) << SSB_PROG_WCNT_2_SHIFT;
102 tmp |= DIV_ROUND_UP(100, ns) << SSB_PROG_WCNT_1_SHIFT;
103 tmp |= DIV_ROUND_UP(120, ns);
104 extif_write32(extif, SSB_EXTIF_PROG_WAITCNT, tmp);
107 void ssb_extif_get_clockcontrol(struct ssb_extif *extif,
108 u32 *pll_type, u32 *n, u32 *m)
110 *pll_type = SSB_PLLTYPE_1;
111 *n = extif_read32(extif, SSB_EXTIF_CLOCK_N);
112 *m = extif_read32(extif, SSB_EXTIF_CLOCK_SB);
115 u32 ssb_extif_watchdog_timer_set_wdt(struct bcm47xx_wdt *wdt, u32 ticks)
117 struct ssb_extif *extif = bcm47xx_wdt_get_drvdata(wdt);
119 return ssb_extif_watchdog_timer_set(extif, ticks);
122 u32 ssb_extif_watchdog_timer_set_ms(struct bcm47xx_wdt *wdt, u32 ms)
124 struct ssb_extif *extif = bcm47xx_wdt_get_drvdata(wdt);
125 u32 ticks = (SSB_EXTIF_WATCHDOG_CLK / 1000) * ms;
127 ticks = ssb_extif_watchdog_timer_set(extif, ticks);
129 return (ticks * 1000) / SSB_EXTIF_WATCHDOG_CLK;
132 u32 ssb_extif_watchdog_timer_set(struct ssb_extif *extif, u32 ticks)
134 if (ticks > SSB_EXTIF_WATCHDOG_MAX_TIMER)
135 ticks = SSB_EXTIF_WATCHDOG_MAX_TIMER;
136 extif_write32(extif, SSB_EXTIF_WATCHDOG, ticks);
138 return ticks;
141 void ssb_extif_init(struct ssb_extif *extif)
143 if (!extif->dev)
144 return; /* We don't have a Extif core */
145 spin_lock_init(&extif->gpio_lock);
148 u32 ssb_extif_gpio_in(struct ssb_extif *extif, u32 mask)
150 return extif_read32(extif, SSB_EXTIF_GPIO_IN) & mask;
153 u32 ssb_extif_gpio_out(struct ssb_extif *extif, u32 mask, u32 value)
155 unsigned long flags;
156 u32 res = 0;
158 spin_lock_irqsave(&extif->gpio_lock, flags);
159 res = extif_write32_masked(extif, SSB_EXTIF_GPIO_OUT(0),
160 mask, value);
161 spin_unlock_irqrestore(&extif->gpio_lock, flags);
163 return res;
166 u32 ssb_extif_gpio_outen(struct ssb_extif *extif, u32 mask, u32 value)
168 unsigned long flags;
169 u32 res = 0;
171 spin_lock_irqsave(&extif->gpio_lock, flags);
172 res = extif_write32_masked(extif, SSB_EXTIF_GPIO_OUTEN(0),
173 mask, value);
174 spin_unlock_irqrestore(&extif->gpio_lock, flags);
176 return res;
179 u32 ssb_extif_gpio_polarity(struct ssb_extif *extif, u32 mask, u32 value)
181 unsigned long flags;
182 u32 res = 0;
184 spin_lock_irqsave(&extif->gpio_lock, flags);
185 res = extif_write32_masked(extif, SSB_EXTIF_GPIO_INTPOL, mask, value);
186 spin_unlock_irqrestore(&extif->gpio_lock, flags);
188 return res;
191 u32 ssb_extif_gpio_intmask(struct ssb_extif *extif, u32 mask, u32 value)
193 unsigned long flags;
194 u32 res = 0;
196 spin_lock_irqsave(&extif->gpio_lock, flags);
197 res = extif_write32_masked(extif, SSB_EXTIF_GPIO_INTMASK, mask, value);
198 spin_unlock_irqrestore(&extif->gpio_lock, flags);
200 return res;