[PATCH 3/6] i.MX23: Add support for the gpio commands
Juergen Beisert
jbe at pengutronix.de
Mon Nov 22 07:24:22 EST 2010
Signed-off-by: Juergen Beisert <jbe at pengutronix.de>
---
arch/arm/mach-stm/iomux-imx23.c | 38 ++++++++++++++++++++++++++++++++++++++
1 files changed, 38 insertions(+), 0 deletions(-)
diff --git a/arch/arm/mach-stm/iomux-imx23.c b/arch/arm/mach-stm/iomux-imx23.c
index 55e7798..88e0218 100644
--- a/arch/arm/mach-stm/iomux-imx23.c
+++ b/arch/arm/mach-stm/iomux-imx23.c
@@ -20,6 +20,7 @@
#include <common.h>
#include <init.h>
#include <gpio.h>
+#include <errno.h>
#include <asm/io.h>
#include <mach/imx-regs.h>
@@ -124,3 +125,40 @@ void imx_gpio_mode(uint32_t m)
}
}
}
+
+void gpio_set_value(unsigned gpio, int val)
+{
+ unsigned reg_offset;
+
+ reg_offset = calc_output_reg(gpio);
+ pr_debug("%u: Accessing %X+%X with value %X\n", gpio, IMX_IOMUXC_BASE,
+ reg_offset, 0x1 << (gpio % 32));
+ writel(0x1 << (gpio % 32),
+ IMX_IOMUXC_BASE + reg_offset + (val != 0 ? 4 : 8));
+}
+
+int gpio_direction_input(unsigned gpio)
+{
+ pr_err("Not yet supported\n");
+ return -EINVAL;
+}
+
+int gpio_direction_output(unsigned gpio, int val)
+{
+ pr_err("Not yet supported\n");
+ return -EINVAL;
+}
+
+int gpio_get_value(unsigned gpio)
+{
+ uint32_t reg;
+ unsigned reg_offset;
+
+ reg_offset = calc_input_reg(gpio);
+ reg = readl(IMX_IOMUXC_BASE + reg_offset);
+ pr_debug("%u: Accessing %X+%X with value %X->%X\n", gpio, IMX_IOMUXC_BASE,
+ reg_offset, 0x1 << (gpio % 32), reg & (0x1 << (gpio % 32)));
+ if (reg & (0x1 << (gpio % 32)))
+ return 1;
+ return 0;
+}
--
1.7.2.3
More information about the barebox
mailing list