Signed-off-by: Alexander Shiyan <shc_work@mail.ru> Signed-off-by: Sascha Hauer <s.hauer@pengutronix.de>
219 lines
4.9 KiB
C
219 lines
4.9 KiB
C
/*
|
|
* arch/arm/mach-imx/gpio.c
|
|
*
|
|
* author: Sascha Hauer
|
|
* Created: april 20th, 2004
|
|
* Copyright: Synertronixx GmbH
|
|
*
|
|
* Common code for i.MX machines
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation; either version 2 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
*
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <errno.h>
|
|
#include <io.h>
|
|
#include <of.h>
|
|
#include <gpio.h>
|
|
#include <init.h>
|
|
|
|
struct imx_gpio_chip {
|
|
void __iomem *base;
|
|
struct gpio_chip chip;
|
|
struct imx_gpio_regs *regs;
|
|
};
|
|
|
|
struct imx_gpio_regs {
|
|
unsigned int dr;
|
|
unsigned int gdir;
|
|
unsigned int psr;
|
|
};
|
|
|
|
static struct imx_gpio_regs regs_imx1 = {
|
|
.dr = 0x1c,
|
|
.gdir = 0x00,
|
|
.psr = 0x24,
|
|
};
|
|
|
|
static struct imx_gpio_regs regs_imx31 = {
|
|
.dr = 0x00,
|
|
.gdir = 0x04,
|
|
.psr = 0x08,
|
|
};
|
|
|
|
static void imx_gpio_set_value(struct gpio_chip *chip, unsigned gpio, int value)
|
|
{
|
|
struct imx_gpio_chip *imxgpio = container_of(chip, struct imx_gpio_chip, chip);
|
|
void __iomem *base = imxgpio->base;
|
|
u32 val;
|
|
|
|
if (!base)
|
|
return;
|
|
|
|
val = readl(base + imxgpio->regs->dr);
|
|
|
|
if (value)
|
|
val |= 1 << gpio;
|
|
else
|
|
val &= ~(1 << gpio);
|
|
|
|
writel(val, base + imxgpio->regs->dr);
|
|
}
|
|
|
|
static int imx_gpio_direction_input(struct gpio_chip *chip, unsigned gpio)
|
|
{
|
|
struct imx_gpio_chip *imxgpio = container_of(chip, struct imx_gpio_chip, chip);
|
|
void __iomem *base = imxgpio->base;
|
|
u32 val;
|
|
|
|
if (!base)
|
|
return -EINVAL;
|
|
|
|
val = readl(base + imxgpio->regs->gdir);
|
|
val &= ~(1 << gpio);
|
|
writel(val, base + imxgpio->regs->gdir);
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
static int imx_gpio_direction_output(struct gpio_chip *chip, unsigned gpio, int value)
|
|
{
|
|
struct imx_gpio_chip *imxgpio = container_of(chip, struct imx_gpio_chip, chip);
|
|
void __iomem *base = imxgpio->base;
|
|
u32 val;
|
|
|
|
gpio_set_value(gpio + chip->base, value);
|
|
|
|
val = readl(base + imxgpio->regs->gdir);
|
|
val |= 1 << gpio;
|
|
writel(val, base + imxgpio->regs->gdir);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int imx_gpio_get_value(struct gpio_chip *chip, unsigned gpio)
|
|
{
|
|
struct imx_gpio_chip *imxgpio = container_of(chip, struct imx_gpio_chip, chip);
|
|
void __iomem *base = imxgpio->base;
|
|
u32 val;
|
|
|
|
val = readl(base + imxgpio->regs->psr);
|
|
|
|
return val & (1 << gpio) ? 1 : 0;
|
|
}
|
|
|
|
static int imx_get_direction(struct gpio_chip *chip, unsigned offset)
|
|
{
|
|
struct imx_gpio_chip *imxgpio = container_of(chip, struct imx_gpio_chip, chip);
|
|
void __iomem *base = imxgpio->base;
|
|
u32 val = readl(base + imxgpio->regs->gdir);
|
|
|
|
return (val & (1 << offset)) ? GPIOF_DIR_OUT : GPIOF_DIR_IN;
|
|
}
|
|
|
|
static struct gpio_ops imx_gpio_ops = {
|
|
.direction_input = imx_gpio_direction_input,
|
|
.direction_output = imx_gpio_direction_output,
|
|
.get = imx_gpio_get_value,
|
|
.set = imx_gpio_set_value,
|
|
.get_direction = imx_get_direction,
|
|
};
|
|
|
|
static int imx_gpio_probe(struct device_d *dev)
|
|
{
|
|
struct imx_gpio_chip *imxgpio;
|
|
struct imx_gpio_regs *regs;
|
|
int ret;
|
|
|
|
ret = dev_get_drvdata(dev, (unsigned long *)®s);
|
|
if (ret)
|
|
return ret;
|
|
|
|
imxgpio = xzalloc(sizeof(*imxgpio));
|
|
imxgpio->base = dev_request_mem_region(dev, 0);
|
|
imxgpio->chip.ops = &imx_gpio_ops;
|
|
if (dev->id < 0) {
|
|
imxgpio->chip.base = of_alias_get_id(dev->device_node, "gpio");
|
|
if (imxgpio->chip.base < 0)
|
|
return imxgpio->chip.base;
|
|
imxgpio->chip.base *= 32;
|
|
} else {
|
|
imxgpio->chip.base = dev->id * 32;
|
|
}
|
|
imxgpio->chip.ngpio = 32;
|
|
imxgpio->chip.dev = dev;
|
|
imxgpio->regs = regs;
|
|
gpiochip_add(&imxgpio->chip);
|
|
|
|
dev_dbg(dev, "probed gpiochip%d with base %d\n", dev->id, imxgpio->chip.base);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static __maybe_unused struct of_device_id imx_gpio_dt_ids[] = {
|
|
{
|
|
.compatible = "fsl,imx1-gpio",
|
|
.data = (unsigned long)®s_imx1,
|
|
}, {
|
|
.compatible = "fsl,imx21-gpio",
|
|
.data = (unsigned long)®s_imx1,
|
|
}, {
|
|
.compatible = "fsl,imx27-gpio",
|
|
.data = (unsigned long)®s_imx1,
|
|
}, {
|
|
.compatible = "fsl,imx31-gpio",
|
|
.data = (unsigned long)®s_imx31,
|
|
}, {
|
|
.compatible = "fsl,imx35-gpio",
|
|
.data = (unsigned long)®s_imx31,
|
|
}, {
|
|
.compatible = "fsl,imx51-gpio",
|
|
.data = (unsigned long)®s_imx31,
|
|
}, {
|
|
.compatible = "fsl,imx53-gpio",
|
|
.data = (unsigned long)®s_imx31,
|
|
}, {
|
|
.compatible = "fsl,imx6q-gpio",
|
|
.data = (unsigned long)®s_imx31,
|
|
}, {
|
|
/* sentinel */
|
|
}
|
|
};
|
|
|
|
static struct platform_device_id imx_gpio_ids[] = {
|
|
{
|
|
.name = "imx1-gpio",
|
|
.driver_data = (unsigned long)®s_imx1,
|
|
}, {
|
|
.name = "imx31-gpio",
|
|
.driver_data = (unsigned long)®s_imx31,
|
|
}, {
|
|
/* sentinel */
|
|
},
|
|
};
|
|
|
|
static struct driver_d imx_gpio_driver = {
|
|
.name = "imx-gpio",
|
|
.probe = imx_gpio_probe,
|
|
.of_compatible = DRV_OF_COMPAT(imx_gpio_dt_ids),
|
|
.id_table = imx_gpio_ids,
|
|
};
|
|
|
|
static int imx_gpio_add(void)
|
|
{
|
|
platform_driver_register(&imx_gpio_driver);
|
|
return 0;
|
|
}
|
|
core_initcall(imx_gpio_add);
|