mirror of
https://source.denx.de/u-boot/u-boot.git
synced 2025-09-19 21:01:51 +02:00
d678a59d2d
When bringing in the series 'arm: dts: am62-beagleplay: Fix Beagleplay Ethernet"' I failed to notice that b4 noticed it was based on next and so took that as the base commit and merged that part of next to master. This reverts commit c8ffd1356d42223cbb8c86280a083cc3c93e6426, reversing changes made to 2ee6f3a5f7550de3599faef9704e166e5dcace35. Reported-by: Jonas Karlman <jonas@kwiboo.se> Signed-off-by: Tom Rini <trini@konsulko.com>
139 lines
3.3 KiB
C
139 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/global_data.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_plat *plat = dev_get_plat(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_plat(struct udevice *dev)
|
|
{
|
|
struct vybrid_gpio_plat *plat = dev_get_plat(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_seq(dev);
|
|
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,
|
|
.of_to_plat = vybrid_gpio_odata_to_plat,
|
|
.probe = vybrid_gpio_probe,
|
|
.priv_auto = sizeof(struct vybrid_gpios),
|
|
.plat_auto = sizeof(struct vybrid_gpio_plat),
|
|
};
|