mirror of
https://github.com/brain-hackers/u-boot-brain
synced 2024-08-27 04:18:51 +09:00
![Peng Fan](/assets/img/avatar_default.png)
This patch add DT support for mxc gpio driver. There are one place using CONFIG_OF_CONTROL macro. 1. The U_BOOT_DEVICES and mxc_plat array are complied out. To DT, platdata is alloced using calloc, so there is no need to use mxc_plat. The following situations are tested, and all work fine: 1. with DM, without DT 2. with DM and DT 3. without DM Since device tree has not been upstreamed, if want to test this patch. The followings need to be done. + pieces of code does not gpio_request when using gpio_direction_xxx and etc, need to request gpio. + move the gpio settings from board_early_init_f to board_init + define CONFIG_DM ,CONFIG_DM_GPIO and CONFIG_OF_CONTROL + Add device tree file and do related configuration in `make ARCH=arm menuconfig` These will be done in future patches by step. Signed-off-by: Peng Fan <Peng.Fan@freescale.com> Acked-by: Igor Grinberg <grinberg@compulab.co.il> Acked-by: Simon Glass <sjg@chromium.org>
371 lines
7.9 KiB
C
371 lines
7.9 KiB
C
/*
|
|
* Copyright (C) 2009
|
|
* Guennadi Liakhovetski, DENX Software Engineering, <lg@denx.de>
|
|
*
|
|
* Copyright (C) 2011
|
|
* Stefano Babic, DENX Software Engineering, <sbabic@denx.de>
|
|
*
|
|
* SPDX-License-Identifier: GPL-2.0+
|
|
*/
|
|
#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)
|
|
[3] = GPIO4_BASE_ADDR,
|
|
#endif
|
|
#if defined(CONFIG_MX27) || defined(CONFIG_MX53) || defined(CONFIG_MX6)
|
|
[4] = GPIO5_BASE_ADDR,
|
|
[5] = GPIO6_BASE_ADDR,
|
|
#endif
|
|
#if defined(CONFIG_MX53) || defined(CONFIG_MX6)
|
|
[6] = GPIO7_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>
|
|
DECLARE_GLOBAL_DATA_PTR;
|
|
|
|
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->uclass_priv;
|
|
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 = dev_get_addr(dev);
|
|
if (addr == FDT_ADDR_T_NONE)
|
|
return -ENODEV;
|
|
|
|
/*
|
|
* 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.
|
|
*/
|
|
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,
|
|
};
|
|
|
|
#ifndef CONFIG_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)
|
|
{ 3, (struct gpio_regs *)GPIO4_BASE_ADDR },
|
|
#endif
|
|
#if defined(CONFIG_MX27) || defined(CONFIG_MX53) || defined(CONFIG_MX6)
|
|
{ 4, (struct gpio_regs *)GPIO5_BASE_ADDR },
|
|
{ 5, (struct gpio_regs *)GPIO6_BASE_ADDR },
|
|
#endif
|
|
#if defined(CONFIG_MX53) || defined(CONFIG_MX6)
|
|
{ 6, (struct gpio_regs *)GPIO7_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)
|
|
{ "gpio_mxc", &mxc_plat[3] },
|
|
#endif
|
|
#if defined(CONFIG_MX27) || defined(CONFIG_MX53) || defined(CONFIG_MX6)
|
|
{ "gpio_mxc", &mxc_plat[4] },
|
|
{ "gpio_mxc", &mxc_plat[5] },
|
|
#endif
|
|
#if defined(CONFIG_MX53) || defined(CONFIG_MX6)
|
|
{ "gpio_mxc", &mxc_plat[6] },
|
|
#endif
|
|
};
|
|
#endif
|
|
#endif
|