mirror of
https://source.denx.de/u-boot/u-boot.git
synced 2025-08-10 01:06:59 +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 commitc8ffd1356d, reversing changes made to2ee6f3a5f7. Reported-by: Jonas Karlman <jonas@kwiboo.se> Signed-off-by: Tom Rini <trini@konsulko.com>
126 lines
2.8 KiB
C
126 lines
2.8 KiB
C
// SPDX-License-Identifier: GPL-2.0+
|
|
/* Copyright (C) 2019 Stephan Gerhold */
|
|
|
|
#include <common.h>
|
|
#include <dm.h>
|
|
#include <asm/gpio.h>
|
|
#include <asm/io.h>
|
|
|
|
struct nmk_gpio_regs {
|
|
u32 dat; /* data */
|
|
u32 dats; /* data set */
|
|
u32 datc; /* data clear */
|
|
u32 pdis; /* pull disable */
|
|
u32 dir; /* direction */
|
|
u32 dirs; /* direction set */
|
|
u32 dirc; /* direction clear */
|
|
u32 slpm; /* sleep mode */
|
|
u32 afsla; /* alternate function select A */
|
|
u32 afslb; /* alternate function select B */
|
|
u32 lowemi; /* low EMI mode */
|
|
};
|
|
|
|
struct nmk_gpio {
|
|
struct nmk_gpio_regs *regs;
|
|
};
|
|
|
|
static int nmk_gpio_get_value(struct udevice *dev, unsigned offset)
|
|
{
|
|
struct nmk_gpio *priv = dev_get_priv(dev);
|
|
|
|
return !!(readl(&priv->regs->dat) & BIT(offset));
|
|
}
|
|
|
|
static int nmk_gpio_set_value(struct udevice *dev, unsigned offset, int value)
|
|
{
|
|
struct nmk_gpio *priv = dev_get_priv(dev);
|
|
|
|
if (value)
|
|
writel(BIT(offset), &priv->regs->dats);
|
|
else
|
|
writel(BIT(offset), &priv->regs->datc);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int nmk_gpio_get_function(struct udevice *dev, unsigned offset)
|
|
{
|
|
struct nmk_gpio *priv = dev_get_priv(dev);
|
|
|
|
if (readl(&priv->regs->afsla) & BIT(offset) ||
|
|
readl(&priv->regs->afslb) & BIT(offset))
|
|
return GPIOF_FUNC;
|
|
|
|
if (readl(&priv->regs->dir) & BIT(offset))
|
|
return GPIOF_OUTPUT;
|
|
else
|
|
return GPIOF_INPUT;
|
|
}
|
|
|
|
static int nmk_gpio_direction_input(struct udevice *dev, unsigned offset)
|
|
{
|
|
struct nmk_gpio *priv = dev_get_priv(dev);
|
|
|
|
writel(BIT(offset), &priv->regs->dirc);
|
|
return 0;
|
|
}
|
|
|
|
static int nmk_gpio_direction_output(struct udevice *dev, unsigned offset,
|
|
int value)
|
|
{
|
|
struct nmk_gpio *priv = dev_get_priv(dev);
|
|
|
|
writel(BIT(offset), &priv->regs->dirs);
|
|
return nmk_gpio_set_value(dev, offset, value);
|
|
}
|
|
|
|
static const struct dm_gpio_ops nmk_gpio_ops = {
|
|
.get_value = nmk_gpio_get_value,
|
|
.set_value = nmk_gpio_set_value,
|
|
.get_function = nmk_gpio_get_function,
|
|
.direction_input = nmk_gpio_direction_input,
|
|
.direction_output = nmk_gpio_direction_output,
|
|
};
|
|
|
|
static int nmk_gpio_probe(struct udevice *dev)
|
|
{
|
|
struct nmk_gpio *priv = dev_get_priv(dev);
|
|
struct gpio_dev_priv *uc_priv = dev_get_uclass_priv(dev);
|
|
char buf[20];
|
|
u32 bank;
|
|
int ret;
|
|
|
|
priv->regs = dev_read_addr_ptr(dev);
|
|
if (!priv->regs)
|
|
return -EINVAL;
|
|
|
|
ret = dev_read_u32(dev, "gpio-bank", &bank);
|
|
if (ret < 0) {
|
|
printf("nmk_gpio(%s): Failed to read gpio-bank\n", dev->name);
|
|
return ret;
|
|
}
|
|
|
|
sprintf(buf, "nmk%u-gpio", bank);
|
|
uc_priv->bank_name = strdup(buf);
|
|
if (!uc_priv->bank_name)
|
|
return -ENOMEM;
|
|
|
|
uc_priv->gpio_count = sizeof(priv->regs->dat) * BITS_PER_BYTE;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct udevice_id nmk_gpio_ids[] = {
|
|
{ .compatible = "st,nomadik-gpio" },
|
|
{ }
|
|
};
|
|
|
|
U_BOOT_DRIVER(gpio_nmk) = {
|
|
.name = "nmk_gpio",
|
|
.id = UCLASS_GPIO,
|
|
.of_match = nmk_gpio_ids,
|
|
.probe = nmk_gpio_probe,
|
|
.ops = &nmk_gpio_ops,
|
|
.priv_auto = sizeof(struct nmk_gpio),
|
|
};
|