mirror of
https://github.com/brain-hackers/u-boot-brain
synced 2024-09-30 00:20:44 +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>
123 lines
3.0 KiB
C
123 lines
3.0 KiB
C
// SPDX-License-Identifier: GPL-2.0+
|
|
/*
|
|
* Copyright (C) 2015 Thomas Chou <thomas@wytron.com.tw>
|
|
* Copyright (C) 2011 Missing Link Electronics
|
|
* Joachim Foerster <joachim@missinglinkelectronics.com>
|
|
*/
|
|
#include <common.h>
|
|
#include <dm.h>
|
|
#include <errno.h>
|
|
#include <malloc.h>
|
|
#include <fdtdec.h>
|
|
#include <asm/io.h>
|
|
#include <asm/gpio.h>
|
|
|
|
DECLARE_GLOBAL_DATA_PTR;
|
|
|
|
struct altera_pio_regs {
|
|
u32 data; /* Data register */
|
|
u32 direction; /* Direction register */
|
|
};
|
|
|
|
struct altera_pio_platdata {
|
|
struct altera_pio_regs *regs;
|
|
int gpio_count;
|
|
const char *bank_name;
|
|
};
|
|
|
|
static int altera_pio_direction_input(struct udevice *dev, unsigned pin)
|
|
{
|
|
struct altera_pio_platdata *plat = dev_get_platdata(dev);
|
|
struct altera_pio_regs *const regs = plat->regs;
|
|
|
|
clrbits_le32(®s->direction, 1 << pin);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int altera_pio_direction_output(struct udevice *dev, unsigned pin,
|
|
int val)
|
|
{
|
|
struct altera_pio_platdata *plat = dev_get_platdata(dev);
|
|
struct altera_pio_regs *const regs = plat->regs;
|
|
|
|
if (val)
|
|
setbits_le32(®s->data, 1 << pin);
|
|
else
|
|
clrbits_le32(®s->data, 1 << pin);
|
|
/* change the data first, then the direction. to avoid glitch */
|
|
setbits_le32(®s->direction, 1 << pin);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int altera_pio_get_value(struct udevice *dev, unsigned pin)
|
|
{
|
|
struct altera_pio_platdata *plat = dev_get_platdata(dev);
|
|
struct altera_pio_regs *const regs = plat->regs;
|
|
|
|
return !!(readl(®s->data) & (1 << pin));
|
|
}
|
|
|
|
|
|
static int altera_pio_set_value(struct udevice *dev, unsigned pin, int val)
|
|
{
|
|
struct altera_pio_platdata *plat = dev_get_platdata(dev);
|
|
struct altera_pio_regs *const regs = plat->regs;
|
|
|
|
if (val)
|
|
setbits_le32(®s->data, 1 << pin);
|
|
else
|
|
clrbits_le32(®s->data, 1 << pin);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int altera_pio_probe(struct udevice *dev)
|
|
{
|
|
struct gpio_dev_priv *uc_priv = dev_get_uclass_priv(dev);
|
|
struct altera_pio_platdata *plat = dev_get_platdata(dev);
|
|
|
|
uc_priv->gpio_count = plat->gpio_count;
|
|
uc_priv->bank_name = plat->bank_name;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int altera_pio_ofdata_to_platdata(struct udevice *dev)
|
|
{
|
|
struct altera_pio_platdata *plat = dev_get_platdata(dev);
|
|
|
|
plat->regs = map_physmem(dev_read_addr(dev),
|
|
sizeof(struct altera_pio_regs),
|
|
MAP_NOCACHE);
|
|
plat->gpio_count = fdtdec_get_int(gd->fdt_blob, dev_of_offset(dev),
|
|
"altr,gpio-bank-width", 32);
|
|
plat->bank_name = fdt_getprop(gd->fdt_blob, dev_of_offset(dev),
|
|
"gpio-bank-name", NULL);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct dm_gpio_ops altera_pio_ops = {
|
|
.direction_input = altera_pio_direction_input,
|
|
.direction_output = altera_pio_direction_output,
|
|
.get_value = altera_pio_get_value,
|
|
.set_value = altera_pio_set_value,
|
|
};
|
|
|
|
static const struct udevice_id altera_pio_ids[] = {
|
|
{ .compatible = "altr,pio-1.0" },
|
|
{ }
|
|
};
|
|
|
|
U_BOOT_DRIVER(altera_pio) = {
|
|
.name = "altera_pio",
|
|
.id = UCLASS_GPIO,
|
|
.of_match = altera_pio_ids,
|
|
.ops = &altera_pio_ops,
|
|
.ofdata_to_platdata = altera_pio_ofdata_to_platdata,
|
|
.platdata_auto = sizeof(struct altera_pio_platdata),
|
|
.probe = altera_pio_probe,
|
|
};
|