This source file includes following definitions.
- imx_iomuxv1_readl
- imx_iomuxv1_writel
- imx_iomuxv1_rmwl
- imx_iomuxv1_set_puen
- imx_iomuxv1_set_ddir
- imx_iomuxv1_set_gpr
- imx_iomuxv1_set_gius
- imx_iomuxv1_set_ocr
- imx_iomuxv1_set_iconfa
- imx_iomuxv1_set_iconfb
- mxc_gpio_mode
- imx_iomuxv1_setup_multiple
- mxc_gpio_setup_multiple_pins
- imx_iomuxv1_init
1
2
3
4
5
6
7
8
9
10
11 #include <linux/errno.h>
12 #include <linux/init.h>
13 #include <linux/kernel.h>
14 #include <linux/module.h>
15 #include <linux/string.h>
16 #include <linux/gpio.h>
17
18 #include <asm/mach/map.h>
19
20 #include "hardware.h"
21 #include "iomux-v1.h"
22
23 static void __iomem *imx_iomuxv1_baseaddr;
24 static unsigned imx_iomuxv1_numports;
25
26 static inline unsigned long imx_iomuxv1_readl(unsigned offset)
27 {
28 return imx_readl(imx_iomuxv1_baseaddr + offset);
29 }
30
31 static inline void imx_iomuxv1_writel(unsigned long val, unsigned offset)
32 {
33 imx_writel(val, imx_iomuxv1_baseaddr + offset);
34 }
35
36 static inline void imx_iomuxv1_rmwl(unsigned offset,
37 unsigned long mask, unsigned long value)
38 {
39 unsigned long reg = imx_iomuxv1_readl(offset);
40
41 reg &= ~mask;
42 reg |= value;
43
44 imx_iomuxv1_writel(reg, offset);
45 }
46
47 static inline void imx_iomuxv1_set_puen(
48 unsigned int port, unsigned int pin, int on)
49 {
50 unsigned long mask = 1 << pin;
51
52 imx_iomuxv1_rmwl(MXC_PUEN(port), mask, on ? mask : 0);
53 }
54
55 static inline void imx_iomuxv1_set_ddir(
56 unsigned int port, unsigned int pin, int out)
57 {
58 unsigned long mask = 1 << pin;
59
60 imx_iomuxv1_rmwl(MXC_DDIR(port), mask, out ? mask : 0);
61 }
62
63 static inline void imx_iomuxv1_set_gpr(
64 unsigned int port, unsigned int pin, int af)
65 {
66 unsigned long mask = 1 << pin;
67
68 imx_iomuxv1_rmwl(MXC_GPR(port), mask, af ? mask : 0);
69 }
70
71 static inline void imx_iomuxv1_set_gius(
72 unsigned int port, unsigned int pin, int inuse)
73 {
74 unsigned long mask = 1 << pin;
75
76 imx_iomuxv1_rmwl(MXC_GIUS(port), mask, inuse ? mask : 0);
77 }
78
79 static inline void imx_iomuxv1_set_ocr(
80 unsigned int port, unsigned int pin, unsigned int ocr)
81 {
82 unsigned long shift = (pin & 0xf) << 1;
83 unsigned long mask = 3 << shift;
84 unsigned long value = ocr << shift;
85 unsigned long offset = pin < 16 ? MXC_OCR1(port) : MXC_OCR2(port);
86
87 imx_iomuxv1_rmwl(offset, mask, value);
88 }
89
90 static inline void imx_iomuxv1_set_iconfa(
91 unsigned int port, unsigned int pin, unsigned int aout)
92 {
93 unsigned long shift = (pin & 0xf) << 1;
94 unsigned long mask = 3 << shift;
95 unsigned long value = aout << shift;
96 unsigned long offset = pin < 16 ? MXC_ICONFA1(port) : MXC_ICONFA2(port);
97
98 imx_iomuxv1_rmwl(offset, mask, value);
99 }
100
101 static inline void imx_iomuxv1_set_iconfb(
102 unsigned int port, unsigned int pin, unsigned int bout)
103 {
104 unsigned long shift = (pin & 0xf) << 1;
105 unsigned long mask = 3 << shift;
106 unsigned long value = bout << shift;
107 unsigned long offset = pin < 16 ? MXC_ICONFB1(port) : MXC_ICONFB2(port);
108
109 imx_iomuxv1_rmwl(offset, mask, value);
110 }
111
112 int mxc_gpio_mode(int gpio_mode)
113 {
114 unsigned int pin = gpio_mode & GPIO_PIN_MASK;
115 unsigned int port = (gpio_mode & GPIO_PORT_MASK) >> GPIO_PORT_SHIFT;
116 unsigned int ocr = (gpio_mode & GPIO_OCR_MASK) >> GPIO_OCR_SHIFT;
117 unsigned int aout = (gpio_mode >> GPIO_AOUT_SHIFT) & 3;
118 unsigned int bout = (gpio_mode >> GPIO_BOUT_SHIFT) & 3;
119
120 if (port >= imx_iomuxv1_numports)
121 return -EINVAL;
122
123
124 imx_iomuxv1_set_puen(port, pin, gpio_mode & GPIO_PUEN);
125
126
127 imx_iomuxv1_set_ddir(port, pin, gpio_mode & GPIO_OUT);
128
129
130 imx_iomuxv1_set_gpr(port, pin, gpio_mode & GPIO_AF);
131
132
133 imx_iomuxv1_set_gius(port, pin, !(gpio_mode & (GPIO_PF | GPIO_AF)));
134
135 imx_iomuxv1_set_ocr(port, pin, ocr);
136
137 imx_iomuxv1_set_iconfa(port, pin, aout);
138
139 imx_iomuxv1_set_iconfb(port, pin, bout);
140
141 return 0;
142 }
143
144 static int imx_iomuxv1_setup_multiple(const int *list, unsigned count)
145 {
146 size_t i;
147 int ret = 0;
148
149 for (i = 0; i < count; ++i) {
150 ret = mxc_gpio_mode(list[i]);
151
152 if (ret)
153 return ret;
154 }
155
156 return ret;
157 }
158
159 int mxc_gpio_setup_multiple_pins(const int *pin_list, unsigned count,
160 const char *label)
161 {
162 int ret;
163
164 ret = imx_iomuxv1_setup_multiple(pin_list, count);
165 return ret;
166 }
167
168 int __init imx_iomuxv1_init(void __iomem *base, int numports)
169 {
170 imx_iomuxv1_baseaddr = base;
171 imx_iomuxv1_numports = numports;
172
173 return 0;
174 }