mirror of
https://mirrors.bfsu.edu.cn/git/linux.git
synced 2024-11-24 12:44:11 +08:00
45a541a610
Some of the drivers do not set parent device. This may lead to obstacles during debugging or understanding the device relations from the Linux point of view. Assign parent device for GPIO chips created by these drivers. While at it, let GPIO library to assign of_node from the parent device. Signed-off-by: Andy Shevchenko <andriy.shevchenko@linux.intel.com> Signed-off-by: Bartosz Golaszewski <brgl@bgdev.pl>
548 lines
14 KiB
C
548 lines
14 KiB
C
// SPDX-License-Identifier: GPL-2.0-or-later
|
|
/*
|
|
* GPIO driver for LPC32xx SoC
|
|
*
|
|
* Author: Kevin Wells <kevin.wells@nxp.com>
|
|
*
|
|
* Copyright (C) 2010 NXP Semiconductors
|
|
*/
|
|
|
|
#include <linux/kernel.h>
|
|
#include <linux/init.h>
|
|
#include <linux/io.h>
|
|
#include <linux/errno.h>
|
|
#include <linux/gpio/driver.h>
|
|
#include <linux/of.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/module.h>
|
|
|
|
#define LPC32XX_GPIO_P3_INP_STATE (0x000)
|
|
#define LPC32XX_GPIO_P3_OUTP_SET (0x004)
|
|
#define LPC32XX_GPIO_P3_OUTP_CLR (0x008)
|
|
#define LPC32XX_GPIO_P3_OUTP_STATE (0x00C)
|
|
#define LPC32XX_GPIO_P2_DIR_SET (0x010)
|
|
#define LPC32XX_GPIO_P2_DIR_CLR (0x014)
|
|
#define LPC32XX_GPIO_P2_DIR_STATE (0x018)
|
|
#define LPC32XX_GPIO_P2_INP_STATE (0x01C)
|
|
#define LPC32XX_GPIO_P2_OUTP_SET (0x020)
|
|
#define LPC32XX_GPIO_P2_OUTP_CLR (0x024)
|
|
#define LPC32XX_GPIO_P2_MUX_SET (0x028)
|
|
#define LPC32XX_GPIO_P2_MUX_CLR (0x02C)
|
|
#define LPC32XX_GPIO_P2_MUX_STATE (0x030)
|
|
#define LPC32XX_GPIO_P0_INP_STATE (0x040)
|
|
#define LPC32XX_GPIO_P0_OUTP_SET (0x044)
|
|
#define LPC32XX_GPIO_P0_OUTP_CLR (0x048)
|
|
#define LPC32XX_GPIO_P0_OUTP_STATE (0x04C)
|
|
#define LPC32XX_GPIO_P0_DIR_SET (0x050)
|
|
#define LPC32XX_GPIO_P0_DIR_CLR (0x054)
|
|
#define LPC32XX_GPIO_P0_DIR_STATE (0x058)
|
|
#define LPC32XX_GPIO_P1_INP_STATE (0x060)
|
|
#define LPC32XX_GPIO_P1_OUTP_SET (0x064)
|
|
#define LPC32XX_GPIO_P1_OUTP_CLR (0x068)
|
|
#define LPC32XX_GPIO_P1_OUTP_STATE (0x06C)
|
|
#define LPC32XX_GPIO_P1_DIR_SET (0x070)
|
|
#define LPC32XX_GPIO_P1_DIR_CLR (0x074)
|
|
#define LPC32XX_GPIO_P1_DIR_STATE (0x078)
|
|
|
|
#define GPIO012_PIN_TO_BIT(x) (1 << (x))
|
|
#define GPIO3_PIN_TO_BIT(x) (1 << ((x) + 25))
|
|
#define GPO3_PIN_TO_BIT(x) (1 << (x))
|
|
#define GPIO012_PIN_IN_SEL(x, y) (((x) >> (y)) & 1)
|
|
#define GPIO3_PIN_IN_SHIFT(x) ((x) == 5 ? 24 : 10 + (x))
|
|
#define GPIO3_PIN_IN_SEL(x, y) (((x) >> GPIO3_PIN_IN_SHIFT(y)) & 1)
|
|
#define GPIO3_PIN5_IN_SEL(x) (((x) >> 24) & 1)
|
|
#define GPI3_PIN_IN_SEL(x, y) (((x) >> (y)) & 1)
|
|
#define GPO3_PIN_IN_SEL(x, y) (((x) >> (y)) & 1)
|
|
|
|
#define LPC32XX_GPIO_P0_MAX 8
|
|
#define LPC32XX_GPIO_P1_MAX 24
|
|
#define LPC32XX_GPIO_P2_MAX 13
|
|
#define LPC32XX_GPIO_P3_MAX 6
|
|
#define LPC32XX_GPI_P3_MAX 29
|
|
#define LPC32XX_GPO_P3_MAX 24
|
|
|
|
#define LPC32XX_GPIO_P0_GRP 0
|
|
#define LPC32XX_GPIO_P1_GRP (LPC32XX_GPIO_P0_GRP + LPC32XX_GPIO_P0_MAX)
|
|
#define LPC32XX_GPIO_P2_GRP (LPC32XX_GPIO_P1_GRP + LPC32XX_GPIO_P1_MAX)
|
|
#define LPC32XX_GPIO_P3_GRP (LPC32XX_GPIO_P2_GRP + LPC32XX_GPIO_P2_MAX)
|
|
#define LPC32XX_GPI_P3_GRP (LPC32XX_GPIO_P3_GRP + LPC32XX_GPIO_P3_MAX)
|
|
#define LPC32XX_GPO_P3_GRP (LPC32XX_GPI_P3_GRP + LPC32XX_GPI_P3_MAX)
|
|
|
|
struct gpio_regs {
|
|
unsigned long inp_state;
|
|
unsigned long outp_state;
|
|
unsigned long outp_set;
|
|
unsigned long outp_clr;
|
|
unsigned long dir_set;
|
|
unsigned long dir_clr;
|
|
};
|
|
|
|
/*
|
|
* GPIO names
|
|
*/
|
|
static const char *gpio_p0_names[LPC32XX_GPIO_P0_MAX] = {
|
|
"p0.0", "p0.1", "p0.2", "p0.3",
|
|
"p0.4", "p0.5", "p0.6", "p0.7"
|
|
};
|
|
|
|
static const char *gpio_p1_names[LPC32XX_GPIO_P1_MAX] = {
|
|
"p1.0", "p1.1", "p1.2", "p1.3",
|
|
"p1.4", "p1.5", "p1.6", "p1.7",
|
|
"p1.8", "p1.9", "p1.10", "p1.11",
|
|
"p1.12", "p1.13", "p1.14", "p1.15",
|
|
"p1.16", "p1.17", "p1.18", "p1.19",
|
|
"p1.20", "p1.21", "p1.22", "p1.23",
|
|
};
|
|
|
|
static const char *gpio_p2_names[LPC32XX_GPIO_P2_MAX] = {
|
|
"p2.0", "p2.1", "p2.2", "p2.3",
|
|
"p2.4", "p2.5", "p2.6", "p2.7",
|
|
"p2.8", "p2.9", "p2.10", "p2.11",
|
|
"p2.12"
|
|
};
|
|
|
|
static const char *gpio_p3_names[LPC32XX_GPIO_P3_MAX] = {
|
|
"gpio00", "gpio01", "gpio02", "gpio03",
|
|
"gpio04", "gpio05"
|
|
};
|
|
|
|
static const char *gpi_p3_names[LPC32XX_GPI_P3_MAX] = {
|
|
"gpi00", "gpi01", "gpi02", "gpi03",
|
|
"gpi04", "gpi05", "gpi06", "gpi07",
|
|
"gpi08", "gpi09", NULL, NULL,
|
|
NULL, NULL, NULL, "gpi15",
|
|
"gpi16", "gpi17", "gpi18", "gpi19",
|
|
"gpi20", "gpi21", "gpi22", "gpi23",
|
|
"gpi24", "gpi25", "gpi26", "gpi27",
|
|
"gpi28"
|
|
};
|
|
|
|
static const char *gpo_p3_names[LPC32XX_GPO_P3_MAX] = {
|
|
"gpo00", "gpo01", "gpo02", "gpo03",
|
|
"gpo04", "gpo05", "gpo06", "gpo07",
|
|
"gpo08", "gpo09", "gpo10", "gpo11",
|
|
"gpo12", "gpo13", "gpo14", "gpo15",
|
|
"gpo16", "gpo17", "gpo18", "gpo19",
|
|
"gpo20", "gpo21", "gpo22", "gpo23"
|
|
};
|
|
|
|
static struct gpio_regs gpio_grp_regs_p0 = {
|
|
.inp_state = LPC32XX_GPIO_P0_INP_STATE,
|
|
.outp_set = LPC32XX_GPIO_P0_OUTP_SET,
|
|
.outp_clr = LPC32XX_GPIO_P0_OUTP_CLR,
|
|
.dir_set = LPC32XX_GPIO_P0_DIR_SET,
|
|
.dir_clr = LPC32XX_GPIO_P0_DIR_CLR,
|
|
};
|
|
|
|
static struct gpio_regs gpio_grp_regs_p1 = {
|
|
.inp_state = LPC32XX_GPIO_P1_INP_STATE,
|
|
.outp_set = LPC32XX_GPIO_P1_OUTP_SET,
|
|
.outp_clr = LPC32XX_GPIO_P1_OUTP_CLR,
|
|
.dir_set = LPC32XX_GPIO_P1_DIR_SET,
|
|
.dir_clr = LPC32XX_GPIO_P1_DIR_CLR,
|
|
};
|
|
|
|
static struct gpio_regs gpio_grp_regs_p2 = {
|
|
.inp_state = LPC32XX_GPIO_P2_INP_STATE,
|
|
.outp_set = LPC32XX_GPIO_P2_OUTP_SET,
|
|
.outp_clr = LPC32XX_GPIO_P2_OUTP_CLR,
|
|
.dir_set = LPC32XX_GPIO_P2_DIR_SET,
|
|
.dir_clr = LPC32XX_GPIO_P2_DIR_CLR,
|
|
};
|
|
|
|
static struct gpio_regs gpio_grp_regs_p3 = {
|
|
.inp_state = LPC32XX_GPIO_P3_INP_STATE,
|
|
.outp_state = LPC32XX_GPIO_P3_OUTP_STATE,
|
|
.outp_set = LPC32XX_GPIO_P3_OUTP_SET,
|
|
.outp_clr = LPC32XX_GPIO_P3_OUTP_CLR,
|
|
.dir_set = LPC32XX_GPIO_P2_DIR_SET,
|
|
.dir_clr = LPC32XX_GPIO_P2_DIR_CLR,
|
|
};
|
|
|
|
struct lpc32xx_gpio_chip {
|
|
struct gpio_chip chip;
|
|
struct gpio_regs *gpio_grp;
|
|
void __iomem *reg_base;
|
|
};
|
|
|
|
static inline u32 gpreg_read(struct lpc32xx_gpio_chip *group, unsigned long offset)
|
|
{
|
|
return __raw_readl(group->reg_base + offset);
|
|
}
|
|
|
|
static inline void gpreg_write(struct lpc32xx_gpio_chip *group, u32 val, unsigned long offset)
|
|
{
|
|
__raw_writel(val, group->reg_base + offset);
|
|
}
|
|
|
|
static void __set_gpio_dir_p012(struct lpc32xx_gpio_chip *group,
|
|
unsigned pin, int input)
|
|
{
|
|
if (input)
|
|
gpreg_write(group, GPIO012_PIN_TO_BIT(pin),
|
|
group->gpio_grp->dir_clr);
|
|
else
|
|
gpreg_write(group, GPIO012_PIN_TO_BIT(pin),
|
|
group->gpio_grp->dir_set);
|
|
}
|
|
|
|
static void __set_gpio_dir_p3(struct lpc32xx_gpio_chip *group,
|
|
unsigned pin, int input)
|
|
{
|
|
u32 u = GPIO3_PIN_TO_BIT(pin);
|
|
|
|
if (input)
|
|
gpreg_write(group, u, group->gpio_grp->dir_clr);
|
|
else
|
|
gpreg_write(group, u, group->gpio_grp->dir_set);
|
|
}
|
|
|
|
static void __set_gpio_level_p012(struct lpc32xx_gpio_chip *group,
|
|
unsigned pin, int high)
|
|
{
|
|
if (high)
|
|
gpreg_write(group, GPIO012_PIN_TO_BIT(pin),
|
|
group->gpio_grp->outp_set);
|
|
else
|
|
gpreg_write(group, GPIO012_PIN_TO_BIT(pin),
|
|
group->gpio_grp->outp_clr);
|
|
}
|
|
|
|
static void __set_gpio_level_p3(struct lpc32xx_gpio_chip *group,
|
|
unsigned pin, int high)
|
|
{
|
|
u32 u = GPIO3_PIN_TO_BIT(pin);
|
|
|
|
if (high)
|
|
gpreg_write(group, u, group->gpio_grp->outp_set);
|
|
else
|
|
gpreg_write(group, u, group->gpio_grp->outp_clr);
|
|
}
|
|
|
|
static void __set_gpo_level_p3(struct lpc32xx_gpio_chip *group,
|
|
unsigned pin, int high)
|
|
{
|
|
if (high)
|
|
gpreg_write(group, GPO3_PIN_TO_BIT(pin), group->gpio_grp->outp_set);
|
|
else
|
|
gpreg_write(group, GPO3_PIN_TO_BIT(pin), group->gpio_grp->outp_clr);
|
|
}
|
|
|
|
static int __get_gpio_state_p012(struct lpc32xx_gpio_chip *group,
|
|
unsigned pin)
|
|
{
|
|
return GPIO012_PIN_IN_SEL(gpreg_read(group, group->gpio_grp->inp_state),
|
|
pin);
|
|
}
|
|
|
|
static int __get_gpio_state_p3(struct lpc32xx_gpio_chip *group,
|
|
unsigned pin)
|
|
{
|
|
int state = gpreg_read(group, group->gpio_grp->inp_state);
|
|
|
|
/*
|
|
* P3 GPIO pin input mapping is not contiguous, GPIOP3-0..4 is mapped
|
|
* to bits 10..14, while GPIOP3-5 is mapped to bit 24.
|
|
*/
|
|
return GPIO3_PIN_IN_SEL(state, pin);
|
|
}
|
|
|
|
static int __get_gpi_state_p3(struct lpc32xx_gpio_chip *group,
|
|
unsigned pin)
|
|
{
|
|
return GPI3_PIN_IN_SEL(gpreg_read(group, group->gpio_grp->inp_state), pin);
|
|
}
|
|
|
|
static int __get_gpo_state_p3(struct lpc32xx_gpio_chip *group,
|
|
unsigned pin)
|
|
{
|
|
return GPO3_PIN_IN_SEL(gpreg_read(group, group->gpio_grp->outp_state), pin);
|
|
}
|
|
|
|
/*
|
|
* GPIO primitives.
|
|
*/
|
|
static int lpc32xx_gpio_dir_input_p012(struct gpio_chip *chip,
|
|
unsigned pin)
|
|
{
|
|
struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
|
|
|
|
__set_gpio_dir_p012(group, pin, 1);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int lpc32xx_gpio_dir_input_p3(struct gpio_chip *chip,
|
|
unsigned pin)
|
|
{
|
|
struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
|
|
|
|
__set_gpio_dir_p3(group, pin, 1);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int lpc32xx_gpio_dir_in_always(struct gpio_chip *chip,
|
|
unsigned pin)
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
static int lpc32xx_gpio_get_value_p012(struct gpio_chip *chip, unsigned pin)
|
|
{
|
|
struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
|
|
|
|
return !!__get_gpio_state_p012(group, pin);
|
|
}
|
|
|
|
static int lpc32xx_gpio_get_value_p3(struct gpio_chip *chip, unsigned pin)
|
|
{
|
|
struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
|
|
|
|
return !!__get_gpio_state_p3(group, pin);
|
|
}
|
|
|
|
static int lpc32xx_gpi_get_value(struct gpio_chip *chip, unsigned pin)
|
|
{
|
|
struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
|
|
|
|
return !!__get_gpi_state_p3(group, pin);
|
|
}
|
|
|
|
static int lpc32xx_gpio_dir_output_p012(struct gpio_chip *chip, unsigned pin,
|
|
int value)
|
|
{
|
|
struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
|
|
|
|
__set_gpio_level_p012(group, pin, value);
|
|
__set_gpio_dir_p012(group, pin, 0);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int lpc32xx_gpio_dir_output_p3(struct gpio_chip *chip, unsigned pin,
|
|
int value)
|
|
{
|
|
struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
|
|
|
|
__set_gpio_level_p3(group, pin, value);
|
|
__set_gpio_dir_p3(group, pin, 0);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int lpc32xx_gpio_dir_out_always(struct gpio_chip *chip, unsigned pin,
|
|
int value)
|
|
{
|
|
struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
|
|
|
|
__set_gpo_level_p3(group, pin, value);
|
|
return 0;
|
|
}
|
|
|
|
static void lpc32xx_gpio_set_value_p012(struct gpio_chip *chip, unsigned pin,
|
|
int value)
|
|
{
|
|
struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
|
|
|
|
__set_gpio_level_p012(group, pin, value);
|
|
}
|
|
|
|
static void lpc32xx_gpio_set_value_p3(struct gpio_chip *chip, unsigned pin,
|
|
int value)
|
|
{
|
|
struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
|
|
|
|
__set_gpio_level_p3(group, pin, value);
|
|
}
|
|
|
|
static void lpc32xx_gpo_set_value(struct gpio_chip *chip, unsigned pin,
|
|
int value)
|
|
{
|
|
struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
|
|
|
|
__set_gpo_level_p3(group, pin, value);
|
|
}
|
|
|
|
static int lpc32xx_gpo_get_value(struct gpio_chip *chip, unsigned pin)
|
|
{
|
|
struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
|
|
|
|
return !!__get_gpo_state_p3(group, pin);
|
|
}
|
|
|
|
static int lpc32xx_gpio_request(struct gpio_chip *chip, unsigned pin)
|
|
{
|
|
if (pin < chip->ngpio)
|
|
return 0;
|
|
|
|
return -EINVAL;
|
|
}
|
|
|
|
static int lpc32xx_gpio_to_irq_p01(struct gpio_chip *chip, unsigned offset)
|
|
{
|
|
return -ENXIO;
|
|
}
|
|
|
|
static int lpc32xx_gpio_to_irq_gpio_p3(struct gpio_chip *chip, unsigned offset)
|
|
{
|
|
return -ENXIO;
|
|
}
|
|
|
|
static int lpc32xx_gpio_to_irq_gpi_p3(struct gpio_chip *chip, unsigned offset)
|
|
{
|
|
return -ENXIO;
|
|
}
|
|
|
|
static struct lpc32xx_gpio_chip lpc32xx_gpiochip[] = {
|
|
{
|
|
.chip = {
|
|
.label = "gpio_p0",
|
|
.direction_input = lpc32xx_gpio_dir_input_p012,
|
|
.get = lpc32xx_gpio_get_value_p012,
|
|
.direction_output = lpc32xx_gpio_dir_output_p012,
|
|
.set = lpc32xx_gpio_set_value_p012,
|
|
.request = lpc32xx_gpio_request,
|
|
.to_irq = lpc32xx_gpio_to_irq_p01,
|
|
.base = LPC32XX_GPIO_P0_GRP,
|
|
.ngpio = LPC32XX_GPIO_P0_MAX,
|
|
.names = gpio_p0_names,
|
|
.can_sleep = false,
|
|
},
|
|
.gpio_grp = &gpio_grp_regs_p0,
|
|
},
|
|
{
|
|
.chip = {
|
|
.label = "gpio_p1",
|
|
.direction_input = lpc32xx_gpio_dir_input_p012,
|
|
.get = lpc32xx_gpio_get_value_p012,
|
|
.direction_output = lpc32xx_gpio_dir_output_p012,
|
|
.set = lpc32xx_gpio_set_value_p012,
|
|
.request = lpc32xx_gpio_request,
|
|
.to_irq = lpc32xx_gpio_to_irq_p01,
|
|
.base = LPC32XX_GPIO_P1_GRP,
|
|
.ngpio = LPC32XX_GPIO_P1_MAX,
|
|
.names = gpio_p1_names,
|
|
.can_sleep = false,
|
|
},
|
|
.gpio_grp = &gpio_grp_regs_p1,
|
|
},
|
|
{
|
|
.chip = {
|
|
.label = "gpio_p2",
|
|
.direction_input = lpc32xx_gpio_dir_input_p012,
|
|
.get = lpc32xx_gpio_get_value_p012,
|
|
.direction_output = lpc32xx_gpio_dir_output_p012,
|
|
.set = lpc32xx_gpio_set_value_p012,
|
|
.request = lpc32xx_gpio_request,
|
|
.base = LPC32XX_GPIO_P2_GRP,
|
|
.ngpio = LPC32XX_GPIO_P2_MAX,
|
|
.names = gpio_p2_names,
|
|
.can_sleep = false,
|
|
},
|
|
.gpio_grp = &gpio_grp_regs_p2,
|
|
},
|
|
{
|
|
.chip = {
|
|
.label = "gpio_p3",
|
|
.direction_input = lpc32xx_gpio_dir_input_p3,
|
|
.get = lpc32xx_gpio_get_value_p3,
|
|
.direction_output = lpc32xx_gpio_dir_output_p3,
|
|
.set = lpc32xx_gpio_set_value_p3,
|
|
.request = lpc32xx_gpio_request,
|
|
.to_irq = lpc32xx_gpio_to_irq_gpio_p3,
|
|
.base = LPC32XX_GPIO_P3_GRP,
|
|
.ngpio = LPC32XX_GPIO_P3_MAX,
|
|
.names = gpio_p3_names,
|
|
.can_sleep = false,
|
|
},
|
|
.gpio_grp = &gpio_grp_regs_p3,
|
|
},
|
|
{
|
|
.chip = {
|
|
.label = "gpi_p3",
|
|
.direction_input = lpc32xx_gpio_dir_in_always,
|
|
.get = lpc32xx_gpi_get_value,
|
|
.request = lpc32xx_gpio_request,
|
|
.to_irq = lpc32xx_gpio_to_irq_gpi_p3,
|
|
.base = LPC32XX_GPI_P3_GRP,
|
|
.ngpio = LPC32XX_GPI_P3_MAX,
|
|
.names = gpi_p3_names,
|
|
.can_sleep = false,
|
|
},
|
|
.gpio_grp = &gpio_grp_regs_p3,
|
|
},
|
|
{
|
|
.chip = {
|
|
.label = "gpo_p3",
|
|
.direction_output = lpc32xx_gpio_dir_out_always,
|
|
.set = lpc32xx_gpo_set_value,
|
|
.get = lpc32xx_gpo_get_value,
|
|
.request = lpc32xx_gpio_request,
|
|
.base = LPC32XX_GPO_P3_GRP,
|
|
.ngpio = LPC32XX_GPO_P3_MAX,
|
|
.names = gpo_p3_names,
|
|
.can_sleep = false,
|
|
},
|
|
.gpio_grp = &gpio_grp_regs_p3,
|
|
},
|
|
};
|
|
|
|
static int lpc32xx_of_xlate(struct gpio_chip *gc,
|
|
const struct of_phandle_args *gpiospec, u32 *flags)
|
|
{
|
|
/* Is this the correct bank? */
|
|
u32 bank = gpiospec->args[0];
|
|
if ((bank >= ARRAY_SIZE(lpc32xx_gpiochip) ||
|
|
(gc != &lpc32xx_gpiochip[bank].chip)))
|
|
return -EINVAL;
|
|
|
|
if (flags)
|
|
*flags = gpiospec->args[2];
|
|
return gpiospec->args[1];
|
|
}
|
|
|
|
static int lpc32xx_gpio_probe(struct platform_device *pdev)
|
|
{
|
|
int i;
|
|
void __iomem *reg_base;
|
|
|
|
reg_base = devm_platform_ioremap_resource(pdev, 0);
|
|
if (IS_ERR(reg_base))
|
|
return PTR_ERR(reg_base);
|
|
|
|
for (i = 0; i < ARRAY_SIZE(lpc32xx_gpiochip); i++) {
|
|
lpc32xx_gpiochip[i].chip.parent = &pdev->dev;
|
|
if (pdev->dev.of_node) {
|
|
lpc32xx_gpiochip[i].chip.of_xlate = lpc32xx_of_xlate;
|
|
lpc32xx_gpiochip[i].chip.of_gpio_n_cells = 3;
|
|
lpc32xx_gpiochip[i].reg_base = reg_base;
|
|
}
|
|
devm_gpiochip_add_data(&pdev->dev, &lpc32xx_gpiochip[i].chip,
|
|
&lpc32xx_gpiochip[i]);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
#ifdef CONFIG_OF
|
|
static const struct of_device_id lpc32xx_gpio_of_match[] = {
|
|
{ .compatible = "nxp,lpc3220-gpio", },
|
|
{ },
|
|
};
|
|
#endif
|
|
|
|
static struct platform_driver lpc32xx_gpio_driver = {
|
|
.driver = {
|
|
.name = "lpc32xx-gpio",
|
|
.of_match_table = of_match_ptr(lpc32xx_gpio_of_match),
|
|
},
|
|
.probe = lpc32xx_gpio_probe,
|
|
};
|
|
|
|
module_platform_driver(lpc32xx_gpio_driver);
|
|
|
|
MODULE_AUTHOR("Kevin Wells <kevin.wells@nxp.com>");
|
|
MODULE_LICENSE("GPL");
|
|
MODULE_DESCRIPTION("GPIO driver for LPC32xx SoC");
|