399 lines
		
	
	
		
			9.0 KiB
		
	
	
	
		
			C
		
	
	
	
			
		
		
	
	
			399 lines
		
	
	
		
			9.0 KiB
		
	
	
	
		
			C
		
	
	
	
| // SPDX-License-Identifier: GPL-2.0+
 | |
| /*
 | |
|  * Copyright (C) 2009
 | |
|  * Guennadi Liakhovetski, DENX Software Engineering, <lg@denx.de>
 | |
|  *
 | |
|  * Copyright (C) 2011
 | |
|  * Stefano Babic, DENX Software Engineering, <sbabic@denx.de>
 | |
|  */
 | |
| #include <common.h>
 | |
| #include <errno.h>
 | |
| #include <dm.h>
 | |
| #include <malloc.h>
 | |
| #include <asm/arch/imx-regs.h>
 | |
| #include <asm/gpio.h>
 | |
| #include <asm/io.h>
 | |
| 
 | |
| enum mxc_gpio_direction {
 | |
| 	MXC_GPIO_DIRECTION_IN,
 | |
| 	MXC_GPIO_DIRECTION_OUT,
 | |
| };
 | |
| 
 | |
| #define GPIO_PER_BANK			32
 | |
| 
 | |
| struct mxc_gpio_plat {
 | |
| 	int bank_index;
 | |
| 	struct gpio_regs *regs;
 | |
| };
 | |
| 
 | |
| struct mxc_bank_info {
 | |
| 	struct gpio_regs *regs;
 | |
| };
 | |
| 
 | |
| #ifndef CONFIG_DM_GPIO
 | |
| #define GPIO_TO_PORT(n)		(n / 32)
 | |
| 
 | |
| /* GPIO port description */
 | |
| static unsigned long gpio_ports[] = {
 | |
| 	[0] = GPIO1_BASE_ADDR,
 | |
| 	[1] = GPIO2_BASE_ADDR,
 | |
| 	[2] = GPIO3_BASE_ADDR,
 | |
| #if defined(CONFIG_MX25) || defined(CONFIG_MX27) || defined(CONFIG_MX51) || \
 | |
| 		defined(CONFIG_MX53) || defined(CONFIG_MX6) || \
 | |
| 		defined(CONFIG_MX7) || defined(CONFIG_IMX8M) || \
 | |
| 		defined(CONFIG_ARCH_IMX8)
 | |
| 	[3] = GPIO4_BASE_ADDR,
 | |
| #endif
 | |
| #if defined(CONFIG_MX27) || defined(CONFIG_MX53) || defined(CONFIG_MX6) || \
 | |
| 		defined(CONFIG_MX7) || defined(CONFIG_IMX8M) || \
 | |
| 		defined(CONFIG_ARCH_IMX8)
 | |
| 	[4] = GPIO5_BASE_ADDR,
 | |
| #if !(defined(CONFIG_MX6UL) || defined(CONFIG_MX6ULL) || defined(CONFIG_IMX8M))
 | |
| 	[5] = GPIO6_BASE_ADDR,
 | |
| #endif
 | |
| #endif
 | |
| #if defined(CONFIG_MX53) || defined(CONFIG_MX6) || defined(CONFIG_MX7) || \
 | |
| 		defined(CONFIG_ARCH_IMX8)
 | |
| #if !(defined(CONFIG_MX6UL) || defined(CONFIG_MX6ULL))
 | |
| 	[6] = GPIO7_BASE_ADDR,
 | |
| #endif
 | |
| #endif
 | |
| #if defined(CONFIG_ARCH_IMX8)
 | |
| 	[7] = GPIO8_BASE_ADDR,
 | |
| #endif
 | |
| };
 | |
| 
 | |
| static int mxc_gpio_direction(unsigned int gpio,
 | |
| 	enum mxc_gpio_direction direction)
 | |
| {
 | |
| 	unsigned int port = GPIO_TO_PORT(gpio);
 | |
| 	struct gpio_regs *regs;
 | |
| 	u32 l;
 | |
| 
 | |
| 	if (port >= ARRAY_SIZE(gpio_ports))
 | |
| 		return -1;
 | |
| 
 | |
| 	gpio &= 0x1f;
 | |
| 
 | |
| 	regs = (struct gpio_regs *)gpio_ports[port];
 | |
| 
 | |
| 	l = readl(®s->gpio_dir);
 | |
| 
 | |
| 	switch (direction) {
 | |
| 	case MXC_GPIO_DIRECTION_OUT:
 | |
| 		l |= 1 << gpio;
 | |
| 		break;
 | |
| 	case MXC_GPIO_DIRECTION_IN:
 | |
| 		l &= ~(1 << gpio);
 | |
| 	}
 | |
| 	writel(l, ®s->gpio_dir);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| int gpio_set_value(unsigned gpio, int value)
 | |
| {
 | |
| 	unsigned int port = GPIO_TO_PORT(gpio);
 | |
| 	struct gpio_regs *regs;
 | |
| 	u32 l;
 | |
| 
 | |
| 	if (port >= ARRAY_SIZE(gpio_ports))
 | |
| 		return -1;
 | |
| 
 | |
| 	gpio &= 0x1f;
 | |
| 
 | |
| 	regs = (struct gpio_regs *)gpio_ports[port];
 | |
| 
 | |
| 	l = readl(®s->gpio_dr);
 | |
| 	if (value)
 | |
| 		l |= 1 << gpio;
 | |
| 	else
 | |
| 		l &= ~(1 << gpio);
 | |
| 	writel(l, ®s->gpio_dr);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| int gpio_get_value(unsigned gpio)
 | |
| {
 | |
| 	unsigned int port = GPIO_TO_PORT(gpio);
 | |
| 	struct gpio_regs *regs;
 | |
| 	u32 val;
 | |
| 
 | |
| 	if (port >= ARRAY_SIZE(gpio_ports))
 | |
| 		return -1;
 | |
| 
 | |
| 	gpio &= 0x1f;
 | |
| 
 | |
| 	regs = (struct gpio_regs *)gpio_ports[port];
 | |
| 
 | |
| 	val = (readl(®s->gpio_psr) >> gpio) & 0x01;
 | |
| 
 | |
| 	return val;
 | |
| }
 | |
| 
 | |
| int gpio_request(unsigned gpio, const char *label)
 | |
| {
 | |
| 	unsigned int port = GPIO_TO_PORT(gpio);
 | |
| 	if (port >= ARRAY_SIZE(gpio_ports))
 | |
| 		return -1;
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| int gpio_free(unsigned gpio)
 | |
| {
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| int gpio_direction_input(unsigned gpio)
 | |
| {
 | |
| 	return mxc_gpio_direction(gpio, MXC_GPIO_DIRECTION_IN);
 | |
| }
 | |
| 
 | |
| int gpio_direction_output(unsigned gpio, int value)
 | |
| {
 | |
| 	int ret = gpio_set_value(gpio, value);
 | |
| 
 | |
| 	if (ret < 0)
 | |
| 		return ret;
 | |
| 
 | |
| 	return mxc_gpio_direction(gpio, MXC_GPIO_DIRECTION_OUT);
 | |
| }
 | |
| #endif
 | |
| 
 | |
| #ifdef CONFIG_DM_GPIO
 | |
| #include <fdtdec.h>
 | |
| static int mxc_gpio_is_output(struct gpio_regs *regs, int offset)
 | |
| {
 | |
| 	u32 val;
 | |
| 
 | |
| 	val = readl(®s->gpio_dir);
 | |
| 
 | |
| 	return val & (1 << offset) ? 1 : 0;
 | |
| }
 | |
| 
 | |
| static void mxc_gpio_bank_direction(struct gpio_regs *regs, int offset,
 | |
| 				    enum mxc_gpio_direction direction)
 | |
| {
 | |
| 	u32 l;
 | |
| 
 | |
| 	l = readl(®s->gpio_dir);
 | |
| 
 | |
| 	switch (direction) {
 | |
| 	case MXC_GPIO_DIRECTION_OUT:
 | |
| 		l |= 1 << offset;
 | |
| 		break;
 | |
| 	case MXC_GPIO_DIRECTION_IN:
 | |
| 		l &= ~(1 << offset);
 | |
| 	}
 | |
| 	writel(l, ®s->gpio_dir);
 | |
| }
 | |
| 
 | |
| static void mxc_gpio_bank_set_value(struct gpio_regs *regs, int offset,
 | |
| 				    int value)
 | |
| {
 | |
| 	u32 l;
 | |
| 
 | |
| 	l = readl(®s->gpio_dr);
 | |
| 	if (value)
 | |
| 		l |= 1 << offset;
 | |
| 	else
 | |
| 		l &= ~(1 << offset);
 | |
| 	writel(l, ®s->gpio_dr);
 | |
| }
 | |
| 
 | |
| static int mxc_gpio_bank_get_value(struct gpio_regs *regs, int offset)
 | |
| {
 | |
| 	return (readl(®s->gpio_psr) >> offset) & 0x01;
 | |
| }
 | |
| 
 | |
| /* set GPIO pin 'gpio' as an input */
 | |
| static int mxc_gpio_direction_input(struct udevice *dev, unsigned offset)
 | |
| {
 | |
| 	struct mxc_bank_info *bank = dev_get_priv(dev);
 | |
| 
 | |
| 	/* Configure GPIO direction as input. */
 | |
| 	mxc_gpio_bank_direction(bank->regs, offset, MXC_GPIO_DIRECTION_IN);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| /* set GPIO pin 'gpio' as an output, with polarity 'value' */
 | |
| static int mxc_gpio_direction_output(struct udevice *dev, unsigned offset,
 | |
| 				       int value)
 | |
| {
 | |
| 	struct mxc_bank_info *bank = dev_get_priv(dev);
 | |
| 
 | |
| 	/* Configure GPIO output value. */
 | |
| 	mxc_gpio_bank_set_value(bank->regs, offset, value);
 | |
| 
 | |
| 	/* Configure GPIO direction as output. */
 | |
| 	mxc_gpio_bank_direction(bank->regs, offset, MXC_GPIO_DIRECTION_OUT);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| /* read GPIO IN value of pin 'gpio' */
 | |
| static int mxc_gpio_get_value(struct udevice *dev, unsigned offset)
 | |
| {
 | |
| 	struct mxc_bank_info *bank = dev_get_priv(dev);
 | |
| 
 | |
| 	return mxc_gpio_bank_get_value(bank->regs, offset);
 | |
| }
 | |
| 
 | |
| /* write GPIO OUT value to pin 'gpio' */
 | |
| static int mxc_gpio_set_value(struct udevice *dev, unsigned offset,
 | |
| 				 int value)
 | |
| {
 | |
| 	struct mxc_bank_info *bank = dev_get_priv(dev);
 | |
| 
 | |
| 	mxc_gpio_bank_set_value(bank->regs, offset, value);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int mxc_gpio_get_function(struct udevice *dev, unsigned offset)
 | |
| {
 | |
| 	struct mxc_bank_info *bank = dev_get_priv(dev);
 | |
| 
 | |
| 	/* GPIOF_FUNC is not implemented yet */
 | |
| 	if (mxc_gpio_is_output(bank->regs, offset))
 | |
| 		return GPIOF_OUTPUT;
 | |
| 	else
 | |
| 		return GPIOF_INPUT;
 | |
| }
 | |
| 
 | |
| static const struct dm_gpio_ops gpio_mxc_ops = {
 | |
| 	.direction_input	= mxc_gpio_direction_input,
 | |
| 	.direction_output	= mxc_gpio_direction_output,
 | |
| 	.get_value		= mxc_gpio_get_value,
 | |
| 	.set_value		= mxc_gpio_set_value,
 | |
| 	.get_function		= mxc_gpio_get_function,
 | |
| };
 | |
| 
 | |
| static int mxc_gpio_probe(struct udevice *dev)
 | |
| {
 | |
| 	struct mxc_bank_info *bank = dev_get_priv(dev);
 | |
| 	struct mxc_gpio_plat *plat = dev_get_platdata(dev);
 | |
| 	struct gpio_dev_priv *uc_priv = dev_get_uclass_priv(dev);
 | |
| 	int banknum;
 | |
| 	char name[18], *str;
 | |
| 
 | |
| 	banknum = plat->bank_index;
 | |
| 	sprintf(name, "GPIO%d_", banknum + 1);
 | |
| 	str = strdup(name);
 | |
| 	if (!str)
 | |
| 		return -ENOMEM;
 | |
| 	uc_priv->bank_name = str;
 | |
| 	uc_priv->gpio_count = GPIO_PER_BANK;
 | |
| 	bank->regs = plat->regs;
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int mxc_gpio_bind(struct udevice *dev)
 | |
| {
 | |
| 	struct mxc_gpio_plat *plat = dev->platdata;
 | |
| 	fdt_addr_t addr;
 | |
| 
 | |
| 	/*
 | |
| 	 * If platdata already exsits, directly return.
 | |
| 	 * Actually only when DT is not supported, platdata
 | |
| 	 * is statically initialized in U_BOOT_DEVICES.Here
 | |
| 	 * will return.
 | |
| 	 */
 | |
| 	if (plat)
 | |
| 		return 0;
 | |
| 
 | |
| 	addr = devfdt_get_addr(dev);
 | |
| 	if (addr == FDT_ADDR_T_NONE)
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	/*
 | |
| 	 * TODO:
 | |
| 	 * When every board is converted to driver model and DT is supported,
 | |
| 	 * this can be done by auto-alloc feature, but not using calloc
 | |
| 	 * to alloc memory for platdata.
 | |
| 	 *
 | |
| 	 * For example mxc_plat below uses platform data rather than device
 | |
| 	 * tree.
 | |
| 	 *
 | |
| 	 * NOTE: DO NOT COPY this code if you are using device tree.
 | |
| 	 */
 | |
| 	plat = calloc(1, sizeof(*plat));
 | |
| 	if (!plat)
 | |
| 		return -ENOMEM;
 | |
| 
 | |
| 	plat->regs = (struct gpio_regs *)addr;
 | |
| 	plat->bank_index = dev->req_seq;
 | |
| 	dev->platdata = plat;
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static const struct udevice_id mxc_gpio_ids[] = {
 | |
| 	{ .compatible = "fsl,imx35-gpio" },
 | |
| 	{ }
 | |
| };
 | |
| 
 | |
| U_BOOT_DRIVER(gpio_mxc) = {
 | |
| 	.name	= "gpio_mxc",
 | |
| 	.id	= UCLASS_GPIO,
 | |
| 	.ops	= &gpio_mxc_ops,
 | |
| 	.probe	= mxc_gpio_probe,
 | |
| 	.priv_auto_alloc_size = sizeof(struct mxc_bank_info),
 | |
| 	.of_match = mxc_gpio_ids,
 | |
| 	.bind	= mxc_gpio_bind,
 | |
| };
 | |
| 
 | |
| #if !CONFIG_IS_ENABLED(OF_CONTROL)
 | |
| static const struct mxc_gpio_plat mxc_plat[] = {
 | |
| 	{ 0, (struct gpio_regs *)GPIO1_BASE_ADDR },
 | |
| 	{ 1, (struct gpio_regs *)GPIO2_BASE_ADDR },
 | |
| 	{ 2, (struct gpio_regs *)GPIO3_BASE_ADDR },
 | |
| #if defined(CONFIG_MX25) || defined(CONFIG_MX27) || defined(CONFIG_MX51) || \
 | |
| 		defined(CONFIG_MX53) || defined(CONFIG_MX6) || \
 | |
| 		defined(CONFIG_IMX8M) || defined(CONFIG_ARCH_IMX8)
 | |
| 	{ 3, (struct gpio_regs *)GPIO4_BASE_ADDR },
 | |
| #endif
 | |
| #if defined(CONFIG_MX27) || defined(CONFIG_MX53) || defined(CONFIG_MX6) || \
 | |
| 		defined(CONFIG_IMX8M) || defined(CONFIG_ARCH_IMX8)
 | |
| 	{ 4, (struct gpio_regs *)GPIO5_BASE_ADDR },
 | |
| #ifndef CONFIG_IMX8M
 | |
| 	{ 5, (struct gpio_regs *)GPIO6_BASE_ADDR },
 | |
| #endif
 | |
| #endif
 | |
| #if defined(CONFIG_MX53) || defined(CONFIG_MX6) || defined(CONFIG_ARCH_IMX8)
 | |
| 	{ 6, (struct gpio_regs *)GPIO7_BASE_ADDR },
 | |
| #endif
 | |
| #if defined(CONFIG_ARCH_IMX8)
 | |
| 	{ 7, (struct gpio_regs *)GPIO8_BASE_ADDR },
 | |
| #endif
 | |
| };
 | |
| 
 | |
| U_BOOT_DEVICES(mxc_gpios) = {
 | |
| 	{ "gpio_mxc", &mxc_plat[0] },
 | |
| 	{ "gpio_mxc", &mxc_plat[1] },
 | |
| 	{ "gpio_mxc", &mxc_plat[2] },
 | |
| #if defined(CONFIG_MX25) || defined(CONFIG_MX27) || defined(CONFIG_MX51) || \
 | |
| 		defined(CONFIG_MX53) || defined(CONFIG_MX6) || \
 | |
| 		defined(CONFIG_IMX8M) || defined(CONFIG_ARCH_IMX8)
 | |
| 	{ "gpio_mxc", &mxc_plat[3] },
 | |
| #endif
 | |
| #if defined(CONFIG_MX27) || defined(CONFIG_MX53) || defined(CONFIG_MX6) || \
 | |
| 		defined(CONFIG_IMX8M) || defined(CONFIG_ARCH_IMX8)
 | |
| 	{ "gpio_mxc", &mxc_plat[4] },
 | |
| #ifndef CONFIG_IMX8M
 | |
| 	{ "gpio_mxc", &mxc_plat[5] },
 | |
| #endif
 | |
| #endif
 | |
| #if defined(CONFIG_MX53) || defined(CONFIG_MX6) || defined(CONFIG_ARCH_IMX8)
 | |
| 	{ "gpio_mxc", &mxc_plat[6] },
 | |
| #endif
 | |
| #if defined(CONFIG_ARCH_IMX8)
 | |
| 	{ "gpio_mxc", &mxc_plat[7] },
 | |
| #endif
 | |
| };
 | |
| #endif
 | |
| #endif
 |