2 * Miscellaneous functions for IDT EB434 board
4 * Copyright 2004 IDT Inc. (rischelp@idt.com)
5 * Copyright 2006 Phil Sutter <n0-1@freewrt.org>
6 * Copyright 2007 Florian Fainelli <florian@openwrt.org>
8 * This program is free software; you can redistribute it and/or modify it
9 * under the terms of the GNU General Public License as published by the
10 * Free Software Foundation; either version 2 of the License, or (at your
11 * option) any later version.
13 * THIS SOFTWARE IS PROVIDED ``AS IS'' AND ANY EXPRESS OR IMPLIED
14 * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
15 * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN
16 * NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
17 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
18 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF
19 * USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
20 * ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
21 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
22 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
24 * You should have received a copy of the GNU General Public License along
25 * with this program; if not, write to the Free Software Foundation, Inc.,
26 * 675 Mass Ave, Cambridge, MA 02139, USA.
29 #include <linux/kernel.h>
30 #include <linux/init.h>
31 #include <linux/types.h>
32 #include <linux/spinlock.h>
33 #include <linux/platform_device.h>
34 #include <linux/gpio.h>
36 #include <asm/mach-rc32434/rb.h>
37 #include <asm/mach-rc32434/gpio.h>
39 struct rb532_gpio_chip
{
40 struct gpio_chip chip
;
41 void __iomem
*regbase
;
42 void (*set_int_level
)(struct gpio_chip
*chip
, unsigned offset
, int value
);
43 int (*get_int_level
)(struct gpio_chip
*chip
, unsigned offset
);
44 void (*set_int_status
)(struct gpio_chip
*chip
, unsigned offset
, int value
);
45 int (*get_int_status
)(struct gpio_chip
*chip
, unsigned offset
);
48 struct mpmc_device dev3
;
50 static struct resource rb532_gpio_reg0_res
[] = {
53 .start
= REGBASE
+ GPIOBASE
,
54 .end
= REGBASE
+ GPIOBASE
+ sizeof(struct rb532_gpio_reg
) - 1,
55 .flags
= IORESOURCE_MEM
,
59 static struct resource rb532_dev3_ctl_res
[] = {
62 .start
= REGBASE
+ DEV3BASE
,
63 .end
= REGBASE
+ DEV3BASE
+ sizeof(struct dev_reg
) - 1,
64 .flags
= IORESOURCE_MEM
,
68 void set_434_reg(unsigned reg_offs
, unsigned bit
, unsigned len
, unsigned val
)
74 spin_lock_irqsave(&dev3
.lock
, flags
);
76 data
= readl(IDT434_REG_BASE
+ reg_offs
);
77 for (i
= 0; i
!= len
; ++i
) {
79 data
|= (1 << (i
+ bit
));
81 data
&= ~(1 << (i
+ bit
));
83 writel(data
, (IDT434_REG_BASE
+ reg_offs
));
85 spin_unlock_irqrestore(&dev3
.lock
, flags
);
87 EXPORT_SYMBOL(set_434_reg
);
89 unsigned get_434_reg(unsigned reg_offs
)
91 return readl(IDT434_REG_BASE
+ reg_offs
);
93 EXPORT_SYMBOL(get_434_reg
);
95 void set_latch_u5(unsigned char or_mask
, unsigned char nand_mask
)
99 spin_lock_irqsave(&dev3
.lock
, flags
);
101 dev3
.state
= (dev3
.state
| or_mask
) & ~nand_mask
;
102 writel(dev3
.state
, &dev3
.base
);
104 spin_unlock_irqrestore(&dev3
.lock
, flags
);
106 EXPORT_SYMBOL(set_latch_u5
);
108 unsigned char get_latch_u5(void)
112 EXPORT_SYMBOL(get_latch_u5
);
115 * Return GPIO level */
116 static int rb532_gpio_get(struct gpio_chip
*chip
, unsigned offset
)
118 u32 mask
= 1 << offset
;
119 struct rb532_gpio_chip
*gpch
;
121 gpch
= container_of(chip
, struct rb532_gpio_chip
, chip
);
122 return readl(gpch
->regbase
+ GPIOD
) & mask
;
126 * Set output GPIO level
128 static void rb532_gpio_set(struct gpio_chip
*chip
,
129 unsigned offset
, int value
)
132 u32 mask
= 1 << offset
;
134 struct rb532_gpio_chip
*gpch
;
137 gpch
= container_of(chip
, struct rb532_gpio_chip
, chip
);
138 gpvr
= gpch
->regbase
+ GPIOD
;
140 local_irq_save(flags
);
147 local_irq_restore(flags
);
151 * Set GPIO direction to input
153 static int rb532_gpio_direction_input(struct gpio_chip
*chip
, unsigned offset
)
156 u32 mask
= 1 << offset
;
158 struct rb532_gpio_chip
*gpch
;
161 gpch
= container_of(chip
, struct rb532_gpio_chip
, chip
);
162 gpdr
= gpch
->regbase
+ GPIOCFG
;
164 local_irq_save(flags
);
168 local_irq_restore(flags
);
174 * Set GPIO direction to output
176 static int rb532_gpio_direction_output(struct gpio_chip
*chip
,
177 unsigned offset
, int value
)
180 u32 mask
= 1 << offset
;
182 struct rb532_gpio_chip
*gpch
;
185 gpch
= container_of(chip
, struct rb532_gpio_chip
, chip
);
186 writel(mask
, gpch
->regbase
+ GPIOD
);
187 gpdr
= gpch
->regbase
+ GPIOCFG
;
189 local_irq_save(flags
);
193 local_irq_restore(flags
);
199 * Set the GPIO interrupt level
201 static void rb532_gpio_set_int_level(struct gpio_chip
*chip
,
202 unsigned offset
, int value
)
205 u32 mask
= 1 << offset
;
207 struct rb532_gpio_chip
*gpch
;
210 gpch
= container_of(chip
, struct rb532_gpio_chip
, chip
);
211 gpil
= gpch
->regbase
+ GPIOILEVEL
;
213 local_irq_save(flags
);
220 local_irq_restore(flags
);
224 * Get the GPIO interrupt level
226 static int rb532_gpio_get_int_level(struct gpio_chip
*chip
, unsigned offset
)
228 u32 mask
= 1 << offset
;
229 struct rb532_gpio_chip
*gpch
;
231 gpch
= container_of(chip
, struct rb532_gpio_chip
, chip
);
232 return readl(gpch
->regbase
+ GPIOILEVEL
) & mask
;
236 * Set the GPIO interrupt status
238 static void rb532_gpio_set_int_status(struct gpio_chip
*chip
,
239 unsigned offset
, int value
)
242 u32 mask
= 1 << offset
;
244 struct rb532_gpio_chip
*gpch
;
247 gpch
= container_of(chip
, struct rb532_gpio_chip
, chip
);
248 gpis
= gpch
->regbase
+ GPIOISTAT
;
250 local_irq_save(flags
);
257 local_irq_restore(flags
);
261 * Get the GPIO interrupt status
263 static int rb532_gpio_get_int_status(struct gpio_chip
*chip
, unsigned offset
)
265 u32 mask
= 1 << offset
;
266 struct rb532_gpio_chip
*gpch
;
268 gpch
= container_of(chip
, struct rb532_gpio_chip
, chip
);
269 return readl(gpch
->regbase
+ GPIOISTAT
) & mask
;
272 static struct rb532_gpio_chip rb532_gpio_chip
[] = {
276 .direction_input
= rb532_gpio_direction_input
,
277 .direction_output
= rb532_gpio_direction_output
,
278 .get
= rb532_gpio_get
,
279 .set
= rb532_gpio_set
,
283 .get_int_level
= rb532_gpio_get_int_level
,
284 .set_int_level
= rb532_gpio_set_int_level
,
285 .get_int_status
= rb532_gpio_get_int_status
,
286 .set_int_status
= rb532_gpio_set_int_status
,
290 int __init
rb532_gpio_init(void)
294 r
= rb532_gpio_reg0_res
;
295 rb532_gpio_chip
->regbase
= ioremap_nocache(r
->start
, r
->end
- r
->start
);
297 if (!rb532_gpio_chip
->regbase
) {
298 printk(KERN_ERR
"rb532: cannot remap GPIO register 0\n");
302 /* Register our GPIO chip */
303 gpiochip_add(&rb532_gpio_chip
->chip
);
305 r
= rb532_dev3_ctl_res
;
306 dev3
.base
= ioremap_nocache(r
->start
, r
->end
- r
->start
);
309 printk(KERN_ERR
"rb532: cannot remap device controller 3\n");
313 /* Set the interrupt status and level for the CF pin */
314 rb532_gpio_set_int_level(&rb532_gpio_chip
->chip
, CF_GPIO_NUM
, 1);
315 rb532_gpio_set_int_status(&rb532_gpio_chip
->chip
, CF_GPIO_NUM
, 0);
319 arch_initcall(rb532_gpio_init
);