diff options
Diffstat (limited to 'firmware/target/arm/imx233/pinctrl-imx233.c')
-rw-r--r-- | firmware/target/arm/imx233/pinctrl-imx233.c | 77 |
1 files changed, 77 insertions, 0 deletions
diff --git a/firmware/target/arm/imx233/pinctrl-imx233.c b/firmware/target/arm/imx233/pinctrl-imx233.c new file mode 100644 index 0000000000..7997292fcb --- /dev/null +++ b/firmware/target/arm/imx233/pinctrl-imx233.c | |||
@@ -0,0 +1,77 @@ | |||
1 | /*************************************************************************** | ||
2 | * __________ __ ___. | ||
3 | * Open \______ \ ____ ____ | | _\_ |__ _______ ___ | ||
4 | * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / | ||
5 | * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < | ||
6 | * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ | ||
7 | * \/ \/ \/ \/ \/ | ||
8 | * $Id$ | ||
9 | * | ||
10 | * Copyright (C) 2011 by Amaury Pouly | ||
11 | * | ||
12 | * This program is free software; you can redistribute it and/or | ||
13 | * modify it under the terms of the GNU General Public License | ||
14 | * as published by the Free Software Foundation; either version 2 | ||
15 | * of the License, or (at your option) any later version. | ||
16 | * | ||
17 | * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY | ||
18 | * KIND, either express or implied. | ||
19 | * | ||
20 | ****************************************************************************/ | ||
21 | #include "system.h" | ||
22 | #include "system-target.h" | ||
23 | #include "cpu.h" | ||
24 | #include "pinctrl-imx233.h" | ||
25 | |||
26 | static pin_irq_cb_t pin_cb[3][32]; /* 3 banks, 32 pins/bank */ | ||
27 | |||
28 | static void INT_GPIO(int bank) | ||
29 | { | ||
30 | uint32_t fire = HW_PINCTRL_IRQSTAT(bank) & HW_PINCTRL_IRQEN(bank); | ||
31 | for(int pin = 0; pin < 32; pin++) | ||
32 | if(fire & (1 << pin)) | ||
33 | { | ||
34 | pin_irq_cb_t cb = pin_cb[bank][pin]; | ||
35 | imx233_setup_pin_irq(bank, pin, false, false, false, NULL); | ||
36 | if(cb) | ||
37 | cb(bank, pin); | ||
38 | } | ||
39 | } | ||
40 | |||
41 | void INT_GPIO0(void) | ||
42 | { | ||
43 | INT_GPIO(0); | ||
44 | } | ||
45 | |||
46 | void INT_GPIO1(void) | ||
47 | { | ||
48 | INT_GPIO(1); | ||
49 | } | ||
50 | |||
51 | void INT_GPIO2(void) | ||
52 | { | ||
53 | INT_GPIO(2); | ||
54 | } | ||
55 | |||
56 | void imx233_setup_pin_irq(int bank, int pin, bool enable_int, | ||
57 | bool level, bool polarity, pin_irq_cb_t cb) | ||
58 | { | ||
59 | __REG_CLR(HW_PINCTRL_PIN2IRQ(bank)) = 1 << pin; | ||
60 | __REG_CLR(HW_PINCTRL_IRQEN(bank)) = 1 << pin; | ||
61 | __REG_CLR(HW_PINCTRL_IRQSTAT(bank))= 1 << pin; | ||
62 | pin_cb[bank][pin] = cb; | ||
63 | if(enable_int) | ||
64 | { | ||
65 | if(level) | ||
66 | __REG_SET(HW_PINCTRL_IRQLEVEL(bank)) = 1 << pin; | ||
67 | else | ||
68 | __REG_CLR(HW_PINCTRL_IRQLEVEL(bank)) = 1 << pin; | ||
69 | if(polarity) | ||
70 | __REG_SET(HW_PINCTRL_IRQPOL(bank)) = 1 << pin; | ||
71 | else | ||
72 | __REG_CLR(HW_PINCTRL_IRQPOL(bank)) = 1 << pin; | ||
73 | __REG_SET(HW_PINCTRL_PIN2IRQ(bank)) = 1 << pin; | ||
74 | __REG_SET(HW_PINCTRL_IRQEN(bank)) = 1 << pin; | ||
75 | imx233_enable_interrupt(INT_SRC_GPIO(bank), true); | ||
76 | } | ||
77 | } | ||