Linux Audio

Check our new training course

Loading...
v6.2
  1// SPDX-License-Identifier: GPL-2.0-or-later
  2/*
  3 * GPIO driver for LPC32xx SoC
  4 *
  5 * Author: Kevin Wells <kevin.wells@nxp.com>
  6 *
  7 * Copyright (C) 2010 NXP Semiconductors
 
 
 
 
 
 
 
 
 
 
  8 */
  9
 10#include <linux/kernel.h>
 11#include <linux/init.h>
 12#include <linux/io.h>
 13#include <linux/errno.h>
 14#include <linux/gpio/driver.h>
 15#include <linux/of.h>
 
 16#include <linux/platform_device.h>
 17#include <linux/module.h>
 
 18
 19#define LPC32XX_GPIO_P3_INP_STATE		(0x000)
 20#define LPC32XX_GPIO_P3_OUTP_SET		(0x004)
 21#define LPC32XX_GPIO_P3_OUTP_CLR		(0x008)
 22#define LPC32XX_GPIO_P3_OUTP_STATE		(0x00C)
 23#define LPC32XX_GPIO_P2_DIR_SET			(0x010)
 24#define LPC32XX_GPIO_P2_DIR_CLR			(0x014)
 25#define LPC32XX_GPIO_P2_DIR_STATE		(0x018)
 26#define LPC32XX_GPIO_P2_INP_STATE		(0x01C)
 27#define LPC32XX_GPIO_P2_OUTP_SET		(0x020)
 28#define LPC32XX_GPIO_P2_OUTP_CLR		(0x024)
 29#define LPC32XX_GPIO_P2_MUX_SET			(0x028)
 30#define LPC32XX_GPIO_P2_MUX_CLR			(0x02C)
 31#define LPC32XX_GPIO_P2_MUX_STATE		(0x030)
 32#define LPC32XX_GPIO_P0_INP_STATE		(0x040)
 33#define LPC32XX_GPIO_P0_OUTP_SET		(0x044)
 34#define LPC32XX_GPIO_P0_OUTP_CLR		(0x048)
 35#define LPC32XX_GPIO_P0_OUTP_STATE		(0x04C)
 36#define LPC32XX_GPIO_P0_DIR_SET			(0x050)
 37#define LPC32XX_GPIO_P0_DIR_CLR			(0x054)
 38#define LPC32XX_GPIO_P0_DIR_STATE		(0x058)
 39#define LPC32XX_GPIO_P1_INP_STATE		(0x060)
 40#define LPC32XX_GPIO_P1_OUTP_SET		(0x064)
 41#define LPC32XX_GPIO_P1_OUTP_CLR		(0x068)
 42#define LPC32XX_GPIO_P1_OUTP_STATE		(0x06C)
 43#define LPC32XX_GPIO_P1_DIR_SET			(0x070)
 44#define LPC32XX_GPIO_P1_DIR_CLR			(0x074)
 45#define LPC32XX_GPIO_P1_DIR_STATE		(0x078)
 
 
 
 
 46
 47#define GPIO012_PIN_TO_BIT(x)			(1 << (x))
 48#define GPIO3_PIN_TO_BIT(x)			(1 << ((x) + 25))
 49#define GPO3_PIN_TO_BIT(x)			(1 << (x))
 50#define GPIO012_PIN_IN_SEL(x, y)		(((x) >> (y)) & 1)
 51#define GPIO3_PIN_IN_SHIFT(x)			((x) == 5 ? 24 : 10 + (x))
 52#define GPIO3_PIN_IN_SEL(x, y)			(((x) >> GPIO3_PIN_IN_SHIFT(y)) & 1)
 53#define GPIO3_PIN5_IN_SEL(x)			(((x) >> 24) & 1)
 54#define GPI3_PIN_IN_SEL(x, y)			(((x) >> (y)) & 1)
 55#define GPO3_PIN_IN_SEL(x, y)			(((x) >> (y)) & 1)
 56
 57#define LPC32XX_GPIO_P0_MAX	8
 58#define LPC32XX_GPIO_P1_MAX	24
 59#define LPC32XX_GPIO_P2_MAX	13
 60#define LPC32XX_GPIO_P3_MAX	6
 61#define LPC32XX_GPI_P3_MAX	29
 62#define LPC32XX_GPO_P3_MAX	24
 63
 64#define LPC32XX_GPIO_P0_GRP	0
 65#define LPC32XX_GPIO_P1_GRP	(LPC32XX_GPIO_P0_GRP + LPC32XX_GPIO_P0_MAX)
 66#define LPC32XX_GPIO_P2_GRP	(LPC32XX_GPIO_P1_GRP + LPC32XX_GPIO_P1_MAX)
 67#define LPC32XX_GPIO_P3_GRP	(LPC32XX_GPIO_P2_GRP + LPC32XX_GPIO_P2_MAX)
 68#define LPC32XX_GPI_P3_GRP	(LPC32XX_GPIO_P3_GRP + LPC32XX_GPIO_P3_MAX)
 69#define LPC32XX_GPO_P3_GRP	(LPC32XX_GPI_P3_GRP + LPC32XX_GPI_P3_MAX)
 70
 71struct gpio_regs {
 72	unsigned long inp_state;
 73	unsigned long outp_state;
 74	unsigned long outp_set;
 75	unsigned long outp_clr;
 76	unsigned long dir_set;
 77	unsigned long dir_clr;
 78};
 79
 80/*
 81 * GPIO names
 82 */
 83static const char *gpio_p0_names[LPC32XX_GPIO_P0_MAX] = {
 84	"p0.0", "p0.1", "p0.2", "p0.3",
 85	"p0.4", "p0.5", "p0.6", "p0.7"
 86};
 87
 88static const char *gpio_p1_names[LPC32XX_GPIO_P1_MAX] = {
 89	"p1.0", "p1.1", "p1.2", "p1.3",
 90	"p1.4", "p1.5", "p1.6", "p1.7",
 91	"p1.8", "p1.9", "p1.10", "p1.11",
 92	"p1.12", "p1.13", "p1.14", "p1.15",
 93	"p1.16", "p1.17", "p1.18", "p1.19",
 94	"p1.20", "p1.21", "p1.22", "p1.23",
 95};
 96
 97static const char *gpio_p2_names[LPC32XX_GPIO_P2_MAX] = {
 98	"p2.0", "p2.1", "p2.2", "p2.3",
 99	"p2.4", "p2.5", "p2.6", "p2.7",
100	"p2.8", "p2.9", "p2.10", "p2.11",
101	"p2.12"
102};
103
104static const char *gpio_p3_names[LPC32XX_GPIO_P3_MAX] = {
105	"gpio00", "gpio01", "gpio02", "gpio03",
106	"gpio04", "gpio05"
107};
108
109static const char *gpi_p3_names[LPC32XX_GPI_P3_MAX] = {
110	"gpi00", "gpi01", "gpi02", "gpi03",
111	"gpi04", "gpi05", "gpi06", "gpi07",
112	"gpi08", "gpi09",  NULL,    NULL,
113	 NULL,    NULL,    NULL,   "gpi15",
114	"gpi16", "gpi17", "gpi18", "gpi19",
115	"gpi20", "gpi21", "gpi22", "gpi23",
116	"gpi24", "gpi25", "gpi26", "gpi27",
117	"gpi28"
118};
119
120static const char *gpo_p3_names[LPC32XX_GPO_P3_MAX] = {
121	"gpo00", "gpo01", "gpo02", "gpo03",
122	"gpo04", "gpo05", "gpo06", "gpo07",
123	"gpo08", "gpo09", "gpo10", "gpo11",
124	"gpo12", "gpo13", "gpo14", "gpo15",
125	"gpo16", "gpo17", "gpo18", "gpo19",
126	"gpo20", "gpo21", "gpo22", "gpo23"
127};
128
129static struct gpio_regs gpio_grp_regs_p0 = {
130	.inp_state	= LPC32XX_GPIO_P0_INP_STATE,
131	.outp_set	= LPC32XX_GPIO_P0_OUTP_SET,
132	.outp_clr	= LPC32XX_GPIO_P0_OUTP_CLR,
133	.dir_set	= LPC32XX_GPIO_P0_DIR_SET,
134	.dir_clr	= LPC32XX_GPIO_P0_DIR_CLR,
135};
136
137static struct gpio_regs gpio_grp_regs_p1 = {
138	.inp_state	= LPC32XX_GPIO_P1_INP_STATE,
139	.outp_set	= LPC32XX_GPIO_P1_OUTP_SET,
140	.outp_clr	= LPC32XX_GPIO_P1_OUTP_CLR,
141	.dir_set	= LPC32XX_GPIO_P1_DIR_SET,
142	.dir_clr	= LPC32XX_GPIO_P1_DIR_CLR,
143};
144
145static struct gpio_regs gpio_grp_regs_p2 = {
146	.inp_state	= LPC32XX_GPIO_P2_INP_STATE,
147	.outp_set	= LPC32XX_GPIO_P2_OUTP_SET,
148	.outp_clr	= LPC32XX_GPIO_P2_OUTP_CLR,
149	.dir_set	= LPC32XX_GPIO_P2_DIR_SET,
150	.dir_clr	= LPC32XX_GPIO_P2_DIR_CLR,
151};
152
153static struct gpio_regs gpio_grp_regs_p3 = {
154	.inp_state	= LPC32XX_GPIO_P3_INP_STATE,
155	.outp_state	= LPC32XX_GPIO_P3_OUTP_STATE,
156	.outp_set	= LPC32XX_GPIO_P3_OUTP_SET,
157	.outp_clr	= LPC32XX_GPIO_P3_OUTP_CLR,
158	.dir_set	= LPC32XX_GPIO_P2_DIR_SET,
159	.dir_clr	= LPC32XX_GPIO_P2_DIR_CLR,
160};
161
162struct lpc32xx_gpio_chip {
163	struct gpio_chip	chip;
164	struct gpio_regs	*gpio_grp;
165	void __iomem		*reg_base;
166};
167
168static inline u32 gpreg_read(struct lpc32xx_gpio_chip *group, unsigned long offset)
 
169{
170	return __raw_readl(group->reg_base + offset);
171}
172
173static inline void gpreg_write(struct lpc32xx_gpio_chip *group, u32 val, unsigned long offset)
174{
175	__raw_writel(val, group->reg_base + offset);
176}
177
178static void __set_gpio_dir_p012(struct lpc32xx_gpio_chip *group,
179	unsigned pin, int input)
180{
181	if (input)
182		gpreg_write(group, GPIO012_PIN_TO_BIT(pin),
183			group->gpio_grp->dir_clr);
184	else
185		gpreg_write(group, GPIO012_PIN_TO_BIT(pin),
186			group->gpio_grp->dir_set);
187}
188
189static void __set_gpio_dir_p3(struct lpc32xx_gpio_chip *group,
190	unsigned pin, int input)
191{
192	u32 u = GPIO3_PIN_TO_BIT(pin);
193
194	if (input)
195		gpreg_write(group, u, group->gpio_grp->dir_clr);
196	else
197		gpreg_write(group, u, group->gpio_grp->dir_set);
198}
199
200static void __set_gpio_level_p012(struct lpc32xx_gpio_chip *group,
201	unsigned pin, int high)
202{
203	if (high)
204		gpreg_write(group, GPIO012_PIN_TO_BIT(pin),
205			group->gpio_grp->outp_set);
206	else
207		gpreg_write(group, GPIO012_PIN_TO_BIT(pin),
208			group->gpio_grp->outp_clr);
209}
210
211static void __set_gpio_level_p3(struct lpc32xx_gpio_chip *group,
212	unsigned pin, int high)
213{
214	u32 u = GPIO3_PIN_TO_BIT(pin);
215
216	if (high)
217		gpreg_write(group, u, group->gpio_grp->outp_set);
218	else
219		gpreg_write(group, u, group->gpio_grp->outp_clr);
220}
221
222static void __set_gpo_level_p3(struct lpc32xx_gpio_chip *group,
223	unsigned pin, int high)
224{
225	if (high)
226		gpreg_write(group, GPO3_PIN_TO_BIT(pin), group->gpio_grp->outp_set);
227	else
228		gpreg_write(group, GPO3_PIN_TO_BIT(pin), group->gpio_grp->outp_clr);
229}
230
231static int __get_gpio_state_p012(struct lpc32xx_gpio_chip *group,
232	unsigned pin)
233{
234	return GPIO012_PIN_IN_SEL(gpreg_read(group, group->gpio_grp->inp_state),
235		pin);
236}
237
238static int __get_gpio_state_p3(struct lpc32xx_gpio_chip *group,
239	unsigned pin)
240{
241	int state = gpreg_read(group, group->gpio_grp->inp_state);
242
243	/*
244	 * P3 GPIO pin input mapping is not contiguous, GPIOP3-0..4 is mapped
245	 * to bits 10..14, while GPIOP3-5 is mapped to bit 24.
246	 */
247	return GPIO3_PIN_IN_SEL(state, pin);
248}
249
250static int __get_gpi_state_p3(struct lpc32xx_gpio_chip *group,
251	unsigned pin)
252{
253	return GPI3_PIN_IN_SEL(gpreg_read(group, group->gpio_grp->inp_state), pin);
254}
255
256static int __get_gpo_state_p3(struct lpc32xx_gpio_chip *group,
257	unsigned pin)
258{
259	return GPO3_PIN_IN_SEL(gpreg_read(group, group->gpio_grp->outp_state), pin);
260}
261
262/*
263 * GPIO primitives.
264 */
265static int lpc32xx_gpio_dir_input_p012(struct gpio_chip *chip,
266	unsigned pin)
267{
268	struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
269
270	__set_gpio_dir_p012(group, pin, 1);
271
272	return 0;
273}
274
275static int lpc32xx_gpio_dir_input_p3(struct gpio_chip *chip,
276	unsigned pin)
277{
278	struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
279
280	__set_gpio_dir_p3(group, pin, 1);
281
282	return 0;
283}
284
285static int lpc32xx_gpio_dir_in_always(struct gpio_chip *chip,
286	unsigned pin)
287{
288	return 0;
289}
290
291static int lpc32xx_gpio_get_value_p012(struct gpio_chip *chip, unsigned pin)
292{
293	struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
294
295	return !!__get_gpio_state_p012(group, pin);
296}
297
298static int lpc32xx_gpio_get_value_p3(struct gpio_chip *chip, unsigned pin)
299{
300	struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
301
302	return !!__get_gpio_state_p3(group, pin);
303}
304
305static int lpc32xx_gpi_get_value(struct gpio_chip *chip, unsigned pin)
306{
307	struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
308
309	return !!__get_gpi_state_p3(group, pin);
310}
311
312static int lpc32xx_gpio_dir_output_p012(struct gpio_chip *chip, unsigned pin,
313	int value)
314{
315	struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
316
317	__set_gpio_level_p012(group, pin, value);
318	__set_gpio_dir_p012(group, pin, 0);
319
320	return 0;
321}
322
323static int lpc32xx_gpio_dir_output_p3(struct gpio_chip *chip, unsigned pin,
324	int value)
325{
326	struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
327
328	__set_gpio_level_p3(group, pin, value);
329	__set_gpio_dir_p3(group, pin, 0);
330
331	return 0;
332}
333
334static int lpc32xx_gpio_dir_out_always(struct gpio_chip *chip, unsigned pin,
335	int value)
336{
337	struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
338
339	__set_gpo_level_p3(group, pin, value);
340	return 0;
341}
342
343static void lpc32xx_gpio_set_value_p012(struct gpio_chip *chip, unsigned pin,
344	int value)
345{
346	struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
347
348	__set_gpio_level_p012(group, pin, value);
349}
350
351static void lpc32xx_gpio_set_value_p3(struct gpio_chip *chip, unsigned pin,
352	int value)
353{
354	struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
355
356	__set_gpio_level_p3(group, pin, value);
357}
358
359static void lpc32xx_gpo_set_value(struct gpio_chip *chip, unsigned pin,
360	int value)
361{
362	struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
363
364	__set_gpo_level_p3(group, pin, value);
365}
366
367static int lpc32xx_gpo_get_value(struct gpio_chip *chip, unsigned pin)
368{
369	struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
370
371	return !!__get_gpo_state_p3(group, pin);
372}
373
374static int lpc32xx_gpio_request(struct gpio_chip *chip, unsigned pin)
375{
376	if (pin < chip->ngpio)
377		return 0;
378
379	return -EINVAL;
380}
381
382static int lpc32xx_gpio_to_irq_p01(struct gpio_chip *chip, unsigned offset)
383{
384	return -ENXIO;
385}
386
 
 
 
 
 
 
 
 
 
387static int lpc32xx_gpio_to_irq_gpio_p3(struct gpio_chip *chip, unsigned offset)
388{
 
 
389	return -ENXIO;
390}
391
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
392static int lpc32xx_gpio_to_irq_gpi_p3(struct gpio_chip *chip, unsigned offset)
393{
 
 
394	return -ENXIO;
395}
396
397static struct lpc32xx_gpio_chip lpc32xx_gpiochip[] = {
398	{
399		.chip = {
400			.label			= "gpio_p0",
401			.direction_input	= lpc32xx_gpio_dir_input_p012,
402			.get			= lpc32xx_gpio_get_value_p012,
403			.direction_output	= lpc32xx_gpio_dir_output_p012,
404			.set			= lpc32xx_gpio_set_value_p012,
405			.request		= lpc32xx_gpio_request,
406			.to_irq			= lpc32xx_gpio_to_irq_p01,
407			.base			= LPC32XX_GPIO_P0_GRP,
408			.ngpio			= LPC32XX_GPIO_P0_MAX,
409			.names			= gpio_p0_names,
410			.can_sleep		= false,
411		},
412		.gpio_grp = &gpio_grp_regs_p0,
413	},
414	{
415		.chip = {
416			.label			= "gpio_p1",
417			.direction_input	= lpc32xx_gpio_dir_input_p012,
418			.get			= lpc32xx_gpio_get_value_p012,
419			.direction_output	= lpc32xx_gpio_dir_output_p012,
420			.set			= lpc32xx_gpio_set_value_p012,
421			.request		= lpc32xx_gpio_request,
422			.to_irq			= lpc32xx_gpio_to_irq_p01,
423			.base			= LPC32XX_GPIO_P1_GRP,
424			.ngpio			= LPC32XX_GPIO_P1_MAX,
425			.names			= gpio_p1_names,
426			.can_sleep		= false,
427		},
428		.gpio_grp = &gpio_grp_regs_p1,
429	},
430	{
431		.chip = {
432			.label			= "gpio_p2",
433			.direction_input	= lpc32xx_gpio_dir_input_p012,
434			.get			= lpc32xx_gpio_get_value_p012,
435			.direction_output	= lpc32xx_gpio_dir_output_p012,
436			.set			= lpc32xx_gpio_set_value_p012,
437			.request		= lpc32xx_gpio_request,
438			.base			= LPC32XX_GPIO_P2_GRP,
439			.ngpio			= LPC32XX_GPIO_P2_MAX,
440			.names			= gpio_p2_names,
441			.can_sleep		= false,
442		},
443		.gpio_grp = &gpio_grp_regs_p2,
444	},
445	{
446		.chip = {
447			.label			= "gpio_p3",
448			.direction_input	= lpc32xx_gpio_dir_input_p3,
449			.get			= lpc32xx_gpio_get_value_p3,
450			.direction_output	= lpc32xx_gpio_dir_output_p3,
451			.set			= lpc32xx_gpio_set_value_p3,
452			.request		= lpc32xx_gpio_request,
453			.to_irq			= lpc32xx_gpio_to_irq_gpio_p3,
454			.base			= LPC32XX_GPIO_P3_GRP,
455			.ngpio			= LPC32XX_GPIO_P3_MAX,
456			.names			= gpio_p3_names,
457			.can_sleep		= false,
458		},
459		.gpio_grp = &gpio_grp_regs_p3,
460	},
461	{
462		.chip = {
463			.label			= "gpi_p3",
464			.direction_input	= lpc32xx_gpio_dir_in_always,
465			.get			= lpc32xx_gpi_get_value,
466			.request		= lpc32xx_gpio_request,
467			.to_irq			= lpc32xx_gpio_to_irq_gpi_p3,
468			.base			= LPC32XX_GPI_P3_GRP,
469			.ngpio			= LPC32XX_GPI_P3_MAX,
470			.names			= gpi_p3_names,
471			.can_sleep		= false,
472		},
473		.gpio_grp = &gpio_grp_regs_p3,
474	},
475	{
476		.chip = {
477			.label			= "gpo_p3",
478			.direction_output	= lpc32xx_gpio_dir_out_always,
479			.set			= lpc32xx_gpo_set_value,
480			.get			= lpc32xx_gpo_get_value,
481			.request		= lpc32xx_gpio_request,
482			.base			= LPC32XX_GPO_P3_GRP,
483			.ngpio			= LPC32XX_GPO_P3_MAX,
484			.names			= gpo_p3_names,
485			.can_sleep		= false,
486		},
487		.gpio_grp = &gpio_grp_regs_p3,
488	},
489};
490
491static int lpc32xx_of_xlate(struct gpio_chip *gc,
492			    const struct of_phandle_args *gpiospec, u32 *flags)
493{
494	/* Is this the correct bank? */
495	u32 bank = gpiospec->args[0];
496	if ((bank >= ARRAY_SIZE(lpc32xx_gpiochip) ||
497	    (gc != &lpc32xx_gpiochip[bank].chip)))
498		return -EINVAL;
499
500	if (flags)
501		*flags = gpiospec->args[2];
502	return gpiospec->args[1];
503}
504
505static int lpc32xx_gpio_probe(struct platform_device *pdev)
506{
507	int i;
508	void __iomem *reg_base;
509
510	reg_base = devm_platform_ioremap_resource(pdev, 0);
511	if (IS_ERR(reg_base))
512		return PTR_ERR(reg_base);
513
514	for (i = 0; i < ARRAY_SIZE(lpc32xx_gpiochip); i++) {
515		lpc32xx_gpiochip[i].chip.parent = &pdev->dev;
516		if (pdev->dev.of_node) {
517			lpc32xx_gpiochip[i].chip.of_xlate = lpc32xx_of_xlate;
518			lpc32xx_gpiochip[i].chip.of_gpio_n_cells = 3;
519			lpc32xx_gpiochip[i].reg_base = reg_base;
520		}
521		devm_gpiochip_add_data(&pdev->dev, &lpc32xx_gpiochip[i].chip,
522				  &lpc32xx_gpiochip[i]);
523	}
524
525	return 0;
526}
527
528#ifdef CONFIG_OF
529static const struct of_device_id lpc32xx_gpio_of_match[] = {
530	{ .compatible = "nxp,lpc3220-gpio", },
531	{ },
532};
533#endif
534
535static struct platform_driver lpc32xx_gpio_driver = {
536	.driver		= {
537		.name	= "lpc32xx-gpio",
 
538		.of_match_table = of_match_ptr(lpc32xx_gpio_of_match),
539	},
540	.probe		= lpc32xx_gpio_probe,
541};
542
543module_platform_driver(lpc32xx_gpio_driver);
544
545MODULE_AUTHOR("Kevin Wells <kevin.wells@nxp.com>");
546MODULE_LICENSE("GPL");
547MODULE_DESCRIPTION("GPIO driver for LPC32xx SoC");
v3.15
 
  1/*
  2 * GPIO driver for LPC32xx SoC
  3 *
  4 * Author: Kevin Wells <kevin.wells@nxp.com>
  5 *
  6 * Copyright (C) 2010 NXP Semiconductors
  7 *
  8 * This program is free software; you can redistribute it and/or modify
  9 * it under the terms of the GNU General Public License as published by
 10 * the Free Software Foundation; either version 2 of the License, or
 11 * (at your option) any later version.
 12 *
 13 * This program is distributed in the hope that it will be useful,
 14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 16 * GNU General Public License for more details.
 17 */
 18
 19#include <linux/kernel.h>
 20#include <linux/init.h>
 21#include <linux/io.h>
 22#include <linux/errno.h>
 23#include <linux/gpio.h>
 24#include <linux/of.h>
 25#include <linux/of_gpio.h>
 26#include <linux/platform_device.h>
 27#include <linux/module.h>
 28#include <linux/platform_data/gpio-lpc32xx.h>
 29
 30#include <mach/hardware.h>
 31#include <mach/platform.h>
 32#include <mach/irqs.h>
 33
 34#define LPC32XX_GPIO_P3_INP_STATE		_GPREG(0x000)
 35#define LPC32XX_GPIO_P3_OUTP_SET		_GPREG(0x004)
 36#define LPC32XX_GPIO_P3_OUTP_CLR		_GPREG(0x008)
 37#define LPC32XX_GPIO_P3_OUTP_STATE		_GPREG(0x00C)
 38#define LPC32XX_GPIO_P2_DIR_SET			_GPREG(0x010)
 39#define LPC32XX_GPIO_P2_DIR_CLR			_GPREG(0x014)
 40#define LPC32XX_GPIO_P2_DIR_STATE		_GPREG(0x018)
 41#define LPC32XX_GPIO_P2_INP_STATE		_GPREG(0x01C)
 42#define LPC32XX_GPIO_P2_OUTP_SET		_GPREG(0x020)
 43#define LPC32XX_GPIO_P2_OUTP_CLR		_GPREG(0x024)
 44#define LPC32XX_GPIO_P2_MUX_SET			_GPREG(0x028)
 45#define LPC32XX_GPIO_P2_MUX_CLR			_GPREG(0x02C)
 46#define LPC32XX_GPIO_P2_MUX_STATE		_GPREG(0x030)
 47#define LPC32XX_GPIO_P0_INP_STATE		_GPREG(0x040)
 48#define LPC32XX_GPIO_P0_OUTP_SET		_GPREG(0x044)
 49#define LPC32XX_GPIO_P0_OUTP_CLR		_GPREG(0x048)
 50#define LPC32XX_GPIO_P0_OUTP_STATE		_GPREG(0x04C)
 51#define LPC32XX_GPIO_P0_DIR_SET			_GPREG(0x050)
 52#define LPC32XX_GPIO_P0_DIR_CLR			_GPREG(0x054)
 53#define LPC32XX_GPIO_P0_DIR_STATE		_GPREG(0x058)
 54#define LPC32XX_GPIO_P1_INP_STATE		_GPREG(0x060)
 55#define LPC32XX_GPIO_P1_OUTP_SET		_GPREG(0x064)
 56#define LPC32XX_GPIO_P1_OUTP_CLR		_GPREG(0x068)
 57#define LPC32XX_GPIO_P1_OUTP_STATE		_GPREG(0x06C)
 58#define LPC32XX_GPIO_P1_DIR_SET			_GPREG(0x070)
 59#define LPC32XX_GPIO_P1_DIR_CLR			_GPREG(0x074)
 60#define LPC32XX_GPIO_P1_DIR_STATE		_GPREG(0x078)
 61
 62#define GPIO012_PIN_TO_BIT(x)			(1 << (x))
 63#define GPIO3_PIN_TO_BIT(x)			(1 << ((x) + 25))
 64#define GPO3_PIN_TO_BIT(x)			(1 << (x))
 65#define GPIO012_PIN_IN_SEL(x, y)		(((x) >> (y)) & 1)
 66#define GPIO3_PIN_IN_SHIFT(x)			((x) == 5 ? 24 : 10 + (x))
 67#define GPIO3_PIN_IN_SEL(x, y)			(((x) >> GPIO3_PIN_IN_SHIFT(y)) & 1)
 68#define GPIO3_PIN5_IN_SEL(x)			(((x) >> 24) & 1)
 69#define GPI3_PIN_IN_SEL(x, y)			(((x) >> (y)) & 1)
 70#define GPO3_PIN_IN_SEL(x, y)			(((x) >> (y)) & 1)
 71
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 72struct gpio_regs {
 73	void __iomem *inp_state;
 74	void __iomem *outp_state;
 75	void __iomem *outp_set;
 76	void __iomem *outp_clr;
 77	void __iomem *dir_set;
 78	void __iomem *dir_clr;
 79};
 80
 81/*
 82 * GPIO names
 83 */
 84static const char *gpio_p0_names[LPC32XX_GPIO_P0_MAX] = {
 85	"p0.0", "p0.1", "p0.2", "p0.3",
 86	"p0.4", "p0.5", "p0.6", "p0.7"
 87};
 88
 89static const char *gpio_p1_names[LPC32XX_GPIO_P1_MAX] = {
 90	"p1.0", "p1.1", "p1.2", "p1.3",
 91	"p1.4", "p1.5", "p1.6", "p1.7",
 92	"p1.8", "p1.9", "p1.10", "p1.11",
 93	"p1.12", "p1.13", "p1.14", "p1.15",
 94	"p1.16", "p1.17", "p1.18", "p1.19",
 95	"p1.20", "p1.21", "p1.22", "p1.23",
 96};
 97
 98static const char *gpio_p2_names[LPC32XX_GPIO_P2_MAX] = {
 99	"p2.0", "p2.1", "p2.2", "p2.3",
100	"p2.4", "p2.5", "p2.6", "p2.7",
101	"p2.8", "p2.9", "p2.10", "p2.11",
102	"p2.12"
103};
104
105static const char *gpio_p3_names[LPC32XX_GPIO_P3_MAX] = {
106	"gpio00", "gpio01", "gpio02", "gpio03",
107	"gpio04", "gpio05"
108};
109
110static const char *gpi_p3_names[LPC32XX_GPI_P3_MAX] = {
111	"gpi00", "gpi01", "gpi02", "gpi03",
112	"gpi04", "gpi05", "gpi06", "gpi07",
113	"gpi08", "gpi09",  NULL,    NULL,
114	 NULL,    NULL,    NULL,   "gpi15",
115	"gpi16", "gpi17", "gpi18", "gpi19",
116	"gpi20", "gpi21", "gpi22", "gpi23",
117	"gpi24", "gpi25", "gpi26", "gpi27",
118	"gpi28"
119};
120
121static const char *gpo_p3_names[LPC32XX_GPO_P3_MAX] = {
122	"gpo00", "gpo01", "gpo02", "gpo03",
123	"gpo04", "gpo05", "gpo06", "gpo07",
124	"gpo08", "gpo09", "gpo10", "gpo11",
125	"gpo12", "gpo13", "gpo14", "gpo15",
126	"gpo16", "gpo17", "gpo18", "gpo19",
127	"gpo20", "gpo21", "gpo22", "gpo23"
128};
129
130static struct gpio_regs gpio_grp_regs_p0 = {
131	.inp_state	= LPC32XX_GPIO_P0_INP_STATE,
132	.outp_set	= LPC32XX_GPIO_P0_OUTP_SET,
133	.outp_clr	= LPC32XX_GPIO_P0_OUTP_CLR,
134	.dir_set	= LPC32XX_GPIO_P0_DIR_SET,
135	.dir_clr	= LPC32XX_GPIO_P0_DIR_CLR,
136};
137
138static struct gpio_regs gpio_grp_regs_p1 = {
139	.inp_state	= LPC32XX_GPIO_P1_INP_STATE,
140	.outp_set	= LPC32XX_GPIO_P1_OUTP_SET,
141	.outp_clr	= LPC32XX_GPIO_P1_OUTP_CLR,
142	.dir_set	= LPC32XX_GPIO_P1_DIR_SET,
143	.dir_clr	= LPC32XX_GPIO_P1_DIR_CLR,
144};
145
146static struct gpio_regs gpio_grp_regs_p2 = {
147	.inp_state	= LPC32XX_GPIO_P2_INP_STATE,
148	.outp_set	= LPC32XX_GPIO_P2_OUTP_SET,
149	.outp_clr	= LPC32XX_GPIO_P2_OUTP_CLR,
150	.dir_set	= LPC32XX_GPIO_P2_DIR_SET,
151	.dir_clr	= LPC32XX_GPIO_P2_DIR_CLR,
152};
153
154static struct gpio_regs gpio_grp_regs_p3 = {
155	.inp_state	= LPC32XX_GPIO_P3_INP_STATE,
156	.outp_state	= LPC32XX_GPIO_P3_OUTP_STATE,
157	.outp_set	= LPC32XX_GPIO_P3_OUTP_SET,
158	.outp_clr	= LPC32XX_GPIO_P3_OUTP_CLR,
159	.dir_set	= LPC32XX_GPIO_P2_DIR_SET,
160	.dir_clr	= LPC32XX_GPIO_P2_DIR_CLR,
161};
162
163struct lpc32xx_gpio_chip {
164	struct gpio_chip	chip;
165	struct gpio_regs	*gpio_grp;
 
166};
167
168static inline struct lpc32xx_gpio_chip *to_lpc32xx_gpio(
169	struct gpio_chip *gpc)
170{
171	return container_of(gpc, struct lpc32xx_gpio_chip, chip);
 
 
 
 
 
172}
173
174static void __set_gpio_dir_p012(struct lpc32xx_gpio_chip *group,
175	unsigned pin, int input)
176{
177	if (input)
178		__raw_writel(GPIO012_PIN_TO_BIT(pin),
179			group->gpio_grp->dir_clr);
180	else
181		__raw_writel(GPIO012_PIN_TO_BIT(pin),
182			group->gpio_grp->dir_set);
183}
184
185static void __set_gpio_dir_p3(struct lpc32xx_gpio_chip *group,
186	unsigned pin, int input)
187{
188	u32 u = GPIO3_PIN_TO_BIT(pin);
189
190	if (input)
191		__raw_writel(u, group->gpio_grp->dir_clr);
192	else
193		__raw_writel(u, group->gpio_grp->dir_set);
194}
195
196static void __set_gpio_level_p012(struct lpc32xx_gpio_chip *group,
197	unsigned pin, int high)
198{
199	if (high)
200		__raw_writel(GPIO012_PIN_TO_BIT(pin),
201			group->gpio_grp->outp_set);
202	else
203		__raw_writel(GPIO012_PIN_TO_BIT(pin),
204			group->gpio_grp->outp_clr);
205}
206
207static void __set_gpio_level_p3(struct lpc32xx_gpio_chip *group,
208	unsigned pin, int high)
209{
210	u32 u = GPIO3_PIN_TO_BIT(pin);
211
212	if (high)
213		__raw_writel(u, group->gpio_grp->outp_set);
214	else
215		__raw_writel(u, group->gpio_grp->outp_clr);
216}
217
218static void __set_gpo_level_p3(struct lpc32xx_gpio_chip *group,
219	unsigned pin, int high)
220{
221	if (high)
222		__raw_writel(GPO3_PIN_TO_BIT(pin), group->gpio_grp->outp_set);
223	else
224		__raw_writel(GPO3_PIN_TO_BIT(pin), group->gpio_grp->outp_clr);
225}
226
227static int __get_gpio_state_p012(struct lpc32xx_gpio_chip *group,
228	unsigned pin)
229{
230	return GPIO012_PIN_IN_SEL(__raw_readl(group->gpio_grp->inp_state),
231		pin);
232}
233
234static int __get_gpio_state_p3(struct lpc32xx_gpio_chip *group,
235	unsigned pin)
236{
237	int state = __raw_readl(group->gpio_grp->inp_state);
238
239	/*
240	 * P3 GPIO pin input mapping is not contiguous, GPIOP3-0..4 is mapped
241	 * to bits 10..14, while GPIOP3-5 is mapped to bit 24.
242	 */
243	return GPIO3_PIN_IN_SEL(state, pin);
244}
245
246static int __get_gpi_state_p3(struct lpc32xx_gpio_chip *group,
247	unsigned pin)
248{
249	return GPI3_PIN_IN_SEL(__raw_readl(group->gpio_grp->inp_state), pin);
250}
251
252static int __get_gpo_state_p3(struct lpc32xx_gpio_chip *group,
253	unsigned pin)
254{
255	return GPO3_PIN_IN_SEL(__raw_readl(group->gpio_grp->outp_state), pin);
256}
257
258/*
259 * GPIO primitives.
260 */
261static int lpc32xx_gpio_dir_input_p012(struct gpio_chip *chip,
262	unsigned pin)
263{
264	struct lpc32xx_gpio_chip *group = to_lpc32xx_gpio(chip);
265
266	__set_gpio_dir_p012(group, pin, 1);
267
268	return 0;
269}
270
271static int lpc32xx_gpio_dir_input_p3(struct gpio_chip *chip,
272	unsigned pin)
273{
274	struct lpc32xx_gpio_chip *group = to_lpc32xx_gpio(chip);
275
276	__set_gpio_dir_p3(group, pin, 1);
277
278	return 0;
279}
280
281static int lpc32xx_gpio_dir_in_always(struct gpio_chip *chip,
282	unsigned pin)
283{
284	return 0;
285}
286
287static int lpc32xx_gpio_get_value_p012(struct gpio_chip *chip, unsigned pin)
288{
289	struct lpc32xx_gpio_chip *group = to_lpc32xx_gpio(chip);
290
291	return __get_gpio_state_p012(group, pin);
292}
293
294static int lpc32xx_gpio_get_value_p3(struct gpio_chip *chip, unsigned pin)
295{
296	struct lpc32xx_gpio_chip *group = to_lpc32xx_gpio(chip);
297
298	return __get_gpio_state_p3(group, pin);
299}
300
301static int lpc32xx_gpi_get_value(struct gpio_chip *chip, unsigned pin)
302{
303	struct lpc32xx_gpio_chip *group = to_lpc32xx_gpio(chip);
304
305	return __get_gpi_state_p3(group, pin);
306}
307
308static int lpc32xx_gpio_dir_output_p012(struct gpio_chip *chip, unsigned pin,
309	int value)
310{
311	struct lpc32xx_gpio_chip *group = to_lpc32xx_gpio(chip);
312
313	__set_gpio_level_p012(group, pin, value);
314	__set_gpio_dir_p012(group, pin, 0);
315
316	return 0;
317}
318
319static int lpc32xx_gpio_dir_output_p3(struct gpio_chip *chip, unsigned pin,
320	int value)
321{
322	struct lpc32xx_gpio_chip *group = to_lpc32xx_gpio(chip);
323
324	__set_gpio_level_p3(group, pin, value);
325	__set_gpio_dir_p3(group, pin, 0);
326
327	return 0;
328}
329
330static int lpc32xx_gpio_dir_out_always(struct gpio_chip *chip, unsigned pin,
331	int value)
332{
333	struct lpc32xx_gpio_chip *group = to_lpc32xx_gpio(chip);
334
335	__set_gpo_level_p3(group, pin, value);
336	return 0;
337}
338
339static void lpc32xx_gpio_set_value_p012(struct gpio_chip *chip, unsigned pin,
340	int value)
341{
342	struct lpc32xx_gpio_chip *group = to_lpc32xx_gpio(chip);
343
344	__set_gpio_level_p012(group, pin, value);
345}
346
347static void lpc32xx_gpio_set_value_p3(struct gpio_chip *chip, unsigned pin,
348	int value)
349{
350	struct lpc32xx_gpio_chip *group = to_lpc32xx_gpio(chip);
351
352	__set_gpio_level_p3(group, pin, value);
353}
354
355static void lpc32xx_gpo_set_value(struct gpio_chip *chip, unsigned pin,
356	int value)
357{
358	struct lpc32xx_gpio_chip *group = to_lpc32xx_gpio(chip);
359
360	__set_gpo_level_p3(group, pin, value);
361}
362
363static int lpc32xx_gpo_get_value(struct gpio_chip *chip, unsigned pin)
364{
365	struct lpc32xx_gpio_chip *group = to_lpc32xx_gpio(chip);
366
367	return __get_gpo_state_p3(group, pin);
368}
369
370static int lpc32xx_gpio_request(struct gpio_chip *chip, unsigned pin)
371{
372	if (pin < chip->ngpio)
373		return 0;
374
375	return -EINVAL;
376}
377
378static int lpc32xx_gpio_to_irq_p01(struct gpio_chip *chip, unsigned offset)
379{
380	return IRQ_LPC32XX_P0_P1_IRQ;
381}
382
383static const char lpc32xx_gpio_to_irq_gpio_p3_table[] = {
384	IRQ_LPC32XX_GPIO_00,
385	IRQ_LPC32XX_GPIO_01,
386	IRQ_LPC32XX_GPIO_02,
387	IRQ_LPC32XX_GPIO_03,
388	IRQ_LPC32XX_GPIO_04,
389	IRQ_LPC32XX_GPIO_05,
390};
391
392static int lpc32xx_gpio_to_irq_gpio_p3(struct gpio_chip *chip, unsigned offset)
393{
394	if (offset < ARRAY_SIZE(lpc32xx_gpio_to_irq_gpio_p3_table))
395		return lpc32xx_gpio_to_irq_gpio_p3_table[offset];
396	return -ENXIO;
397}
398
399static const char lpc32xx_gpio_to_irq_gpi_p3_table[] = {
400	IRQ_LPC32XX_GPI_00,
401	IRQ_LPC32XX_GPI_01,
402	IRQ_LPC32XX_GPI_02,
403	IRQ_LPC32XX_GPI_03,
404	IRQ_LPC32XX_GPI_04,
405	IRQ_LPC32XX_GPI_05,
406	IRQ_LPC32XX_GPI_06,
407	IRQ_LPC32XX_GPI_07,
408	IRQ_LPC32XX_GPI_08,
409	IRQ_LPC32XX_GPI_09,
410	-ENXIO, /* 10 */
411	-ENXIO, /* 11 */
412	-ENXIO, /* 12 */
413	-ENXIO, /* 13 */
414	-ENXIO, /* 14 */
415	-ENXIO, /* 15 */
416	-ENXIO, /* 16 */
417	-ENXIO, /* 17 */
418	-ENXIO, /* 18 */
419	IRQ_LPC32XX_GPI_19,
420	-ENXIO, /* 20 */
421	-ENXIO, /* 21 */
422	-ENXIO, /* 22 */
423	-ENXIO, /* 23 */
424	-ENXIO, /* 24 */
425	-ENXIO, /* 25 */
426	-ENXIO, /* 26 */
427	-ENXIO, /* 27 */
428	IRQ_LPC32XX_GPI_28,
429};
430
431static int lpc32xx_gpio_to_irq_gpi_p3(struct gpio_chip *chip, unsigned offset)
432{
433	if (offset < ARRAY_SIZE(lpc32xx_gpio_to_irq_gpi_p3_table))
434		return lpc32xx_gpio_to_irq_gpi_p3_table[offset];
435	return -ENXIO;
436}
437
438static struct lpc32xx_gpio_chip lpc32xx_gpiochip[] = {
439	{
440		.chip = {
441			.label			= "gpio_p0",
442			.direction_input	= lpc32xx_gpio_dir_input_p012,
443			.get			= lpc32xx_gpio_get_value_p012,
444			.direction_output	= lpc32xx_gpio_dir_output_p012,
445			.set			= lpc32xx_gpio_set_value_p012,
446			.request		= lpc32xx_gpio_request,
447			.to_irq			= lpc32xx_gpio_to_irq_p01,
448			.base			= LPC32XX_GPIO_P0_GRP,
449			.ngpio			= LPC32XX_GPIO_P0_MAX,
450			.names			= gpio_p0_names,
451			.can_sleep		= false,
452		},
453		.gpio_grp = &gpio_grp_regs_p0,
454	},
455	{
456		.chip = {
457			.label			= "gpio_p1",
458			.direction_input	= lpc32xx_gpio_dir_input_p012,
459			.get			= lpc32xx_gpio_get_value_p012,
460			.direction_output	= lpc32xx_gpio_dir_output_p012,
461			.set			= lpc32xx_gpio_set_value_p012,
462			.request		= lpc32xx_gpio_request,
463			.to_irq			= lpc32xx_gpio_to_irq_p01,
464			.base			= LPC32XX_GPIO_P1_GRP,
465			.ngpio			= LPC32XX_GPIO_P1_MAX,
466			.names			= gpio_p1_names,
467			.can_sleep		= false,
468		},
469		.gpio_grp = &gpio_grp_regs_p1,
470	},
471	{
472		.chip = {
473			.label			= "gpio_p2",
474			.direction_input	= lpc32xx_gpio_dir_input_p012,
475			.get			= lpc32xx_gpio_get_value_p012,
476			.direction_output	= lpc32xx_gpio_dir_output_p012,
477			.set			= lpc32xx_gpio_set_value_p012,
478			.request		= lpc32xx_gpio_request,
479			.base			= LPC32XX_GPIO_P2_GRP,
480			.ngpio			= LPC32XX_GPIO_P2_MAX,
481			.names			= gpio_p2_names,
482			.can_sleep		= false,
483		},
484		.gpio_grp = &gpio_grp_regs_p2,
485	},
486	{
487		.chip = {
488			.label			= "gpio_p3",
489			.direction_input	= lpc32xx_gpio_dir_input_p3,
490			.get			= lpc32xx_gpio_get_value_p3,
491			.direction_output	= lpc32xx_gpio_dir_output_p3,
492			.set			= lpc32xx_gpio_set_value_p3,
493			.request		= lpc32xx_gpio_request,
494			.to_irq			= lpc32xx_gpio_to_irq_gpio_p3,
495			.base			= LPC32XX_GPIO_P3_GRP,
496			.ngpio			= LPC32XX_GPIO_P3_MAX,
497			.names			= gpio_p3_names,
498			.can_sleep		= false,
499		},
500		.gpio_grp = &gpio_grp_regs_p3,
501	},
502	{
503		.chip = {
504			.label			= "gpi_p3",
505			.direction_input	= lpc32xx_gpio_dir_in_always,
506			.get			= lpc32xx_gpi_get_value,
507			.request		= lpc32xx_gpio_request,
508			.to_irq			= lpc32xx_gpio_to_irq_gpi_p3,
509			.base			= LPC32XX_GPI_P3_GRP,
510			.ngpio			= LPC32XX_GPI_P3_MAX,
511			.names			= gpi_p3_names,
512			.can_sleep		= false,
513		},
514		.gpio_grp = &gpio_grp_regs_p3,
515	},
516	{
517		.chip = {
518			.label			= "gpo_p3",
519			.direction_output	= lpc32xx_gpio_dir_out_always,
520			.set			= lpc32xx_gpo_set_value,
521			.get			= lpc32xx_gpo_get_value,
522			.request		= lpc32xx_gpio_request,
523			.base			= LPC32XX_GPO_P3_GRP,
524			.ngpio			= LPC32XX_GPO_P3_MAX,
525			.names			= gpo_p3_names,
526			.can_sleep		= false,
527		},
528		.gpio_grp = &gpio_grp_regs_p3,
529	},
530};
531
532static int lpc32xx_of_xlate(struct gpio_chip *gc,
533			    const struct of_phandle_args *gpiospec, u32 *flags)
534{
535	/* Is this the correct bank? */
536	u32 bank = gpiospec->args[0];
537	if ((bank >= ARRAY_SIZE(lpc32xx_gpiochip) ||
538	    (gc != &lpc32xx_gpiochip[bank].chip)))
539		return -EINVAL;
540
541	if (flags)
542		*flags = gpiospec->args[2];
543	return gpiospec->args[1];
544}
545
546static int lpc32xx_gpio_probe(struct platform_device *pdev)
547{
548	int i;
 
 
 
 
 
549
550	for (i = 0; i < ARRAY_SIZE(lpc32xx_gpiochip); i++) {
 
551		if (pdev->dev.of_node) {
552			lpc32xx_gpiochip[i].chip.of_xlate = lpc32xx_of_xlate;
553			lpc32xx_gpiochip[i].chip.of_gpio_n_cells = 3;
554			lpc32xx_gpiochip[i].chip.of_node = pdev->dev.of_node;
555		}
556		gpiochip_add(&lpc32xx_gpiochip[i].chip);
 
557	}
558
559	return 0;
560}
561
562#ifdef CONFIG_OF
563static struct of_device_id lpc32xx_gpio_of_match[] = {
564	{ .compatible = "nxp,lpc3220-gpio", },
565	{ },
566};
567#endif
568
569static struct platform_driver lpc32xx_gpio_driver = {
570	.driver		= {
571		.name	= "lpc32xx-gpio",
572		.owner	= THIS_MODULE,
573		.of_match_table = of_match_ptr(lpc32xx_gpio_of_match),
574	},
575	.probe		= lpc32xx_gpio_probe,
576};
577
578module_platform_driver(lpc32xx_gpio_driver);