mirror of
https://github.com/brain-hackers/u-boot-brain
synced 2024-06-09 23:36:03 +09:00
41575d8e4c
This construct is quite long-winded. In earlier days it made some sense since auto-allocation was a strange concept. But with driver model now used pretty universally, we can shorten this to 'auto'. This reduces verbosity and makes it easier to read. Coincidentally it also ensures that every declaration is on one line, thus making dtoc's job easier. Signed-off-by: Simon Glass <sjg@chromium.org>
138 lines
3.3 KiB
C
138 lines
3.3 KiB
C
// SPDX-License-Identifier: GPL-2.0+
|
|
/*
|
|
* Copyright (C) 2015
|
|
* Bhuvanchandra DV, Toradex, Inc.
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <dm.h>
|
|
#include <errno.h>
|
|
#include <fdtdec.h>
|
|
#include <asm/gpio.h>
|
|
#include <asm/mach-imx/iomux-v3.h>
|
|
#include <asm/io.h>
|
|
#include <malloc.h>
|
|
|
|
DECLARE_GLOBAL_DATA_PTR;
|
|
|
|
struct vybrid_gpios {
|
|
unsigned int chip;
|
|
struct vybrid_gpio_regs *reg;
|
|
};
|
|
|
|
static int vybrid_gpio_direction_input(struct udevice *dev, unsigned gpio)
|
|
{
|
|
const struct vybrid_gpios *gpios = dev_get_priv(dev);
|
|
|
|
gpio = gpio + (gpios->chip * VYBRID_GPIO_COUNT);
|
|
imx_iomux_gpio_set_direction(gpio, VF610_GPIO_DIRECTION_IN);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int vybrid_gpio_direction_output(struct udevice *dev, unsigned gpio,
|
|
int value)
|
|
{
|
|
const struct vybrid_gpios *gpios = dev_get_priv(dev);
|
|
|
|
gpio = gpio + (gpios->chip * VYBRID_GPIO_COUNT);
|
|
gpio_set_value(gpio, value);
|
|
imx_iomux_gpio_set_direction(gpio, VF610_GPIO_DIRECTION_OUT);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int vybrid_gpio_get_value(struct udevice *dev, unsigned gpio)
|
|
{
|
|
const struct vybrid_gpios *gpios = dev_get_priv(dev);
|
|
|
|
return ((readl(&gpios->reg->gpio_pdir) & (1 << gpio))) ? 1 : 0;
|
|
}
|
|
|
|
static int vybrid_gpio_set_value(struct udevice *dev, unsigned gpio,
|
|
int value)
|
|
{
|
|
const struct vybrid_gpios *gpios = dev_get_priv(dev);
|
|
if (value)
|
|
writel((1 << gpio), &gpios->reg->gpio_psor);
|
|
else
|
|
writel((1 << gpio), &gpios->reg->gpio_pcor);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int vybrid_gpio_get_function(struct udevice *dev, unsigned gpio)
|
|
{
|
|
const struct vybrid_gpios *gpios = dev_get_priv(dev);
|
|
u32 g_state = 0;
|
|
|
|
gpio = gpio + (gpios->chip * VYBRID_GPIO_COUNT);
|
|
|
|
imx_iomux_gpio_get_function(gpio, &g_state);
|
|
|
|
if (((g_state & (0x07 << PAD_MUX_MODE_SHIFT)) >> PAD_MUX_MODE_SHIFT) > 0)
|
|
return GPIOF_FUNC;
|
|
if (g_state & PAD_CTL_OBE_ENABLE)
|
|
return GPIOF_OUTPUT;
|
|
if (g_state & PAD_CTL_IBE_ENABLE)
|
|
return GPIOF_INPUT;
|
|
if (!(g_state & PAD_CTL_OBE_IBE_ENABLE))
|
|
return GPIOF_UNUSED;
|
|
|
|
return GPIOF_UNKNOWN;
|
|
}
|
|
|
|
static const struct dm_gpio_ops gpio_vybrid_ops = {
|
|
.direction_input = vybrid_gpio_direction_input,
|
|
.direction_output = vybrid_gpio_direction_output,
|
|
.get_value = vybrid_gpio_get_value,
|
|
.set_value = vybrid_gpio_set_value,
|
|
.get_function = vybrid_gpio_get_function,
|
|
};
|
|
|
|
static int vybrid_gpio_probe(struct udevice *dev)
|
|
{
|
|
struct vybrid_gpios *gpios = dev_get_priv(dev);
|
|
struct vybrid_gpio_platdata *plat = dev_get_platdata(dev);
|
|
struct gpio_dev_priv *uc_priv = dev_get_uclass_priv(dev);
|
|
|
|
uc_priv->bank_name = plat->port_name;
|
|
uc_priv->gpio_count = VYBRID_GPIO_COUNT;
|
|
gpios->reg = (struct vybrid_gpio_regs *)plat->base;
|
|
gpios->chip = plat->chip;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int vybrid_gpio_odata_to_platdata(struct udevice *dev)
|
|
{
|
|
struct vybrid_gpio_platdata *plat = dev_get_platdata(dev);
|
|
fdt_addr_t base_addr;
|
|
|
|
base_addr = dev_read_addr(dev);
|
|
if (base_addr == FDT_ADDR_T_NONE)
|
|
return -EINVAL;
|
|
|
|
plat->base = base_addr;
|
|
plat->chip = dev->req_seq;
|
|
plat->port_name = fdt_get_name(gd->fdt_blob, dev_of_offset(dev), NULL);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct udevice_id vybrid_gpio_ids[] = {
|
|
{ .compatible = "fsl,vf610-gpio" },
|
|
{ }
|
|
};
|
|
|
|
U_BOOT_DRIVER(gpio_vybrid) = {
|
|
.name = "gpio_vybrid",
|
|
.id = UCLASS_GPIO,
|
|
.ops = &gpio_vybrid_ops,
|
|
.of_match = vybrid_gpio_ids,
|
|
.ofdata_to_platdata = vybrid_gpio_odata_to_platdata,
|
|
.probe = vybrid_gpio_probe,
|
|
.priv_auto = sizeof(struct vybrid_gpios),
|
|
.platdata_auto = sizeof(struct vybrid_gpio_platdata),
|
|
};
|