4 * Copyright (c) 2008 Sascha Hauer <s.hauer@pengutronix.de>, Pengutronix
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License version 2
8 * as published by the Free Software Foundation.
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
15 * You should have received a copy of the GNU General Public License
16 * along with this program; if not, write to the Free Software
17 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
21 #include <linux/kernel.h>
22 #include <linux/slab.h>
23 #include <linux/of_gpio.h>
25 #include <linux/of_platform.h>
26 #include <linux/module.h>
29 #include <asm/mpc52xx.h>
30 #include <sysdev/fsl_soc.h>
32 static DEFINE_SPINLOCK(gpio_lock
);
34 struct mpc52xx_gpiochip
{
35 struct of_mm_gpio_chip mmchip
;
36 unsigned int shadow_dvo
;
37 unsigned int shadow_gpioe
;
38 unsigned int shadow_ddr
;
42 * GPIO LIB API implementation for wakeup GPIOs.
44 * There's a maximum of 8 wakeup GPIOs. Which of these are available
45 * for use depends on your board setup.
57 static int mpc52xx_wkup_gpio_get(struct gpio_chip
*gc
, unsigned int gpio
)
59 struct of_mm_gpio_chip
*mm_gc
= to_of_mm_gpio_chip(gc
);
60 struct mpc52xx_gpio_wkup __iomem
*regs
= mm_gc
->regs
;
63 ret
= (in_8(®s
->wkup_ival
) >> (7 - gpio
)) & 1;
65 pr_debug("%s: gpio: %d ret: %d\n", __func__
, gpio
, ret
);
71 __mpc52xx_wkup_gpio_set(struct gpio_chip
*gc
, unsigned int gpio
, int val
)
73 struct of_mm_gpio_chip
*mm_gc
= to_of_mm_gpio_chip(gc
);
74 struct mpc52xx_gpiochip
*chip
= container_of(mm_gc
,
75 struct mpc52xx_gpiochip
, mmchip
);
76 struct mpc52xx_gpio_wkup __iomem
*regs
= mm_gc
->regs
;
79 chip
->shadow_dvo
|= 1 << (7 - gpio
);
81 chip
->shadow_dvo
&= ~(1 << (7 - gpio
));
83 out_8(®s
->wkup_dvo
, chip
->shadow_dvo
);
87 mpc52xx_wkup_gpio_set(struct gpio_chip
*gc
, unsigned int gpio
, int val
)
91 spin_lock_irqsave(&gpio_lock
, flags
);
93 __mpc52xx_wkup_gpio_set(gc
, gpio
, val
);
95 spin_unlock_irqrestore(&gpio_lock
, flags
);
97 pr_debug("%s: gpio: %d val: %d\n", __func__
, gpio
, val
);
100 static int mpc52xx_wkup_gpio_dir_in(struct gpio_chip
*gc
, unsigned int gpio
)
102 struct of_mm_gpio_chip
*mm_gc
= to_of_mm_gpio_chip(gc
);
103 struct mpc52xx_gpiochip
*chip
= container_of(mm_gc
,
104 struct mpc52xx_gpiochip
, mmchip
);
105 struct mpc52xx_gpio_wkup __iomem
*regs
= mm_gc
->regs
;
108 spin_lock_irqsave(&gpio_lock
, flags
);
110 /* set the direction */
111 chip
->shadow_ddr
&= ~(1 << (7 - gpio
));
112 out_8(®s
->wkup_ddr
, chip
->shadow_ddr
);
114 /* and enable the pin */
115 chip
->shadow_gpioe
|= 1 << (7 - gpio
);
116 out_8(®s
->wkup_gpioe
, chip
->shadow_gpioe
);
118 spin_unlock_irqrestore(&gpio_lock
, flags
);
124 mpc52xx_wkup_gpio_dir_out(struct gpio_chip
*gc
, unsigned int gpio
, int val
)
126 struct of_mm_gpio_chip
*mm_gc
= to_of_mm_gpio_chip(gc
);
127 struct mpc52xx_gpio_wkup __iomem
*regs
= mm_gc
->regs
;
128 struct mpc52xx_gpiochip
*chip
= container_of(mm_gc
,
129 struct mpc52xx_gpiochip
, mmchip
);
132 spin_lock_irqsave(&gpio_lock
, flags
);
134 __mpc52xx_wkup_gpio_set(gc
, gpio
, val
);
136 /* Then set direction */
137 chip
->shadow_ddr
|= 1 << (7 - gpio
);
138 out_8(®s
->wkup_ddr
, chip
->shadow_ddr
);
140 /* Finally enable the pin */
141 chip
->shadow_gpioe
|= 1 << (7 - gpio
);
142 out_8(®s
->wkup_gpioe
, chip
->shadow_gpioe
);
144 spin_unlock_irqrestore(&gpio_lock
, flags
);
146 pr_debug("%s: gpio: %d val: %d\n", __func__
, gpio
, val
);
151 static int mpc52xx_wkup_gpiochip_probe(struct platform_device
*ofdev
)
153 struct mpc52xx_gpiochip
*chip
;
154 struct mpc52xx_gpio_wkup __iomem
*regs
;
155 struct gpio_chip
*gc
;
158 chip
= kzalloc(sizeof(*chip
), GFP_KERNEL
);
162 gc
= &chip
->mmchip
.gc
;
165 gc
->direction_input
= mpc52xx_wkup_gpio_dir_in
;
166 gc
->direction_output
= mpc52xx_wkup_gpio_dir_out
;
167 gc
->get
= mpc52xx_wkup_gpio_get
;
168 gc
->set
= mpc52xx_wkup_gpio_set
;
170 ret
= of_mm_gpiochip_add(ofdev
->dev
.of_node
, &chip
->mmchip
);
174 regs
= chip
->mmchip
.regs
;
175 chip
->shadow_gpioe
= in_8(®s
->wkup_gpioe
);
176 chip
->shadow_ddr
= in_8(®s
->wkup_ddr
);
177 chip
->shadow_dvo
= in_8(®s
->wkup_dvo
);
182 static int mpc52xx_gpiochip_remove(struct platform_device
*ofdev
)
187 static const struct of_device_id mpc52xx_wkup_gpiochip_match
[] = {
188 { .compatible
= "fsl,mpc5200-gpio-wkup", },
192 static struct platform_driver mpc52xx_wkup_gpiochip_driver
= {
194 .name
= "mpc5200-gpio-wkup",
195 .of_match_table
= mpc52xx_wkup_gpiochip_match
,
197 .probe
= mpc52xx_wkup_gpiochip_probe
,
198 .remove
= mpc52xx_gpiochip_remove
,
202 * GPIO LIB API implementation for simple GPIOs
204 * There's a maximum of 32 simple GPIOs. Which of these are available
205 * for use depends on your board setup.
206 * The numbering reflects the bit numbering in the port registers:
218 static int mpc52xx_simple_gpio_get(struct gpio_chip
*gc
, unsigned int gpio
)
220 struct of_mm_gpio_chip
*mm_gc
= to_of_mm_gpio_chip(gc
);
221 struct mpc52xx_gpio __iomem
*regs
= mm_gc
->regs
;
224 ret
= (in_be32(®s
->simple_ival
) >> (31 - gpio
)) & 1;
230 __mpc52xx_simple_gpio_set(struct gpio_chip
*gc
, unsigned int gpio
, int val
)
232 struct of_mm_gpio_chip
*mm_gc
= to_of_mm_gpio_chip(gc
);
233 struct mpc52xx_gpiochip
*chip
= container_of(mm_gc
,
234 struct mpc52xx_gpiochip
, mmchip
);
235 struct mpc52xx_gpio __iomem
*regs
= mm_gc
->regs
;
238 chip
->shadow_dvo
|= 1 << (31 - gpio
);
240 chip
->shadow_dvo
&= ~(1 << (31 - gpio
));
241 out_be32(®s
->simple_dvo
, chip
->shadow_dvo
);
245 mpc52xx_simple_gpio_set(struct gpio_chip
*gc
, unsigned int gpio
, int val
)
249 spin_lock_irqsave(&gpio_lock
, flags
);
251 __mpc52xx_simple_gpio_set(gc
, gpio
, val
);
253 spin_unlock_irqrestore(&gpio_lock
, flags
);
255 pr_debug("%s: gpio: %d val: %d\n", __func__
, gpio
, val
);
258 static int mpc52xx_simple_gpio_dir_in(struct gpio_chip
*gc
, unsigned int gpio
)
260 struct of_mm_gpio_chip
*mm_gc
= to_of_mm_gpio_chip(gc
);
261 struct mpc52xx_gpiochip
*chip
= container_of(mm_gc
,
262 struct mpc52xx_gpiochip
, mmchip
);
263 struct mpc52xx_gpio __iomem
*regs
= mm_gc
->regs
;
266 spin_lock_irqsave(&gpio_lock
, flags
);
268 /* set the direction */
269 chip
->shadow_ddr
&= ~(1 << (31 - gpio
));
270 out_be32(®s
->simple_ddr
, chip
->shadow_ddr
);
272 /* and enable the pin */
273 chip
->shadow_gpioe
|= 1 << (31 - gpio
);
274 out_be32(®s
->simple_gpioe
, chip
->shadow_gpioe
);
276 spin_unlock_irqrestore(&gpio_lock
, flags
);
282 mpc52xx_simple_gpio_dir_out(struct gpio_chip
*gc
, unsigned int gpio
, int val
)
284 struct of_mm_gpio_chip
*mm_gc
= to_of_mm_gpio_chip(gc
);
285 struct mpc52xx_gpiochip
*chip
= container_of(mm_gc
,
286 struct mpc52xx_gpiochip
, mmchip
);
287 struct mpc52xx_gpio __iomem
*regs
= mm_gc
->regs
;
290 spin_lock_irqsave(&gpio_lock
, flags
);
292 /* First set initial value */
293 __mpc52xx_simple_gpio_set(gc
, gpio
, val
);
295 /* Then set direction */
296 chip
->shadow_ddr
|= 1 << (31 - gpio
);
297 out_be32(®s
->simple_ddr
, chip
->shadow_ddr
);
299 /* Finally enable the pin */
300 chip
->shadow_gpioe
|= 1 << (31 - gpio
);
301 out_be32(®s
->simple_gpioe
, chip
->shadow_gpioe
);
303 spin_unlock_irqrestore(&gpio_lock
, flags
);
305 pr_debug("%s: gpio: %d val: %d\n", __func__
, gpio
, val
);
310 static int mpc52xx_simple_gpiochip_probe(struct platform_device
*ofdev
)
312 struct mpc52xx_gpiochip
*chip
;
313 struct gpio_chip
*gc
;
314 struct mpc52xx_gpio __iomem
*regs
;
317 chip
= kzalloc(sizeof(*chip
), GFP_KERNEL
);
321 gc
= &chip
->mmchip
.gc
;
324 gc
->direction_input
= mpc52xx_simple_gpio_dir_in
;
325 gc
->direction_output
= mpc52xx_simple_gpio_dir_out
;
326 gc
->get
= mpc52xx_simple_gpio_get
;
327 gc
->set
= mpc52xx_simple_gpio_set
;
329 ret
= of_mm_gpiochip_add(ofdev
->dev
.of_node
, &chip
->mmchip
);
333 regs
= chip
->mmchip
.regs
;
334 chip
->shadow_gpioe
= in_be32(®s
->simple_gpioe
);
335 chip
->shadow_ddr
= in_be32(®s
->simple_ddr
);
336 chip
->shadow_dvo
= in_be32(®s
->simple_dvo
);
341 static const struct of_device_id mpc52xx_simple_gpiochip_match
[] = {
342 { .compatible
= "fsl,mpc5200-gpio", },
346 static struct platform_driver mpc52xx_simple_gpiochip_driver
= {
348 .name
= "mpc5200-gpio",
349 .of_match_table
= mpc52xx_simple_gpiochip_match
,
351 .probe
= mpc52xx_simple_gpiochip_probe
,
352 .remove
= mpc52xx_gpiochip_remove
,
355 static int __init
mpc52xx_gpio_init(void)
357 if (platform_driver_register(&mpc52xx_wkup_gpiochip_driver
))
358 printk(KERN_ERR
"Unable to register wakeup GPIO driver\n");
360 if (platform_driver_register(&mpc52xx_simple_gpiochip_driver
))
361 printk(KERN_ERR
"Unable to register simple GPIO driver\n");
367 /* Make sure we get initialised before anyone else tries to use us */
368 subsys_initcall(mpc52xx_gpio_init
);
370 /* No exit call at the moment as we cannot unregister of gpio chips */
372 MODULE_DESCRIPTION("Freescale MPC52xx gpio driver");
373 MODULE_AUTHOR("Sascha Hauer <s.hauer@pengutronix.de");
374 MODULE_LICENSE("GPL v2");