Commit | Line | Data |
---|---|---|
2be6bb0c PM |
1 | /* |
2 | * Common INTC2 register accessors | |
3 | * | |
4 | * Copyright (C) 2007, 2008 Magnus Damm | |
5 | * Copyright (C) 2009, 2010 Paul Mundt | |
6 | * | |
7 | * This file is subject to the terms and conditions of the GNU General Public | |
8 | * License. See the file "COPYING" in the main directory of this archive | |
9 | * for more details. | |
10 | */ | |
11 | #include <linux/io.h> | |
12 | #include "internals.h" | |
13 | ||
14 | unsigned long intc_phys_to_virt(struct intc_desc_int *d, unsigned long address) | |
15 | { | |
16 | struct intc_window *window; | |
17 | int k; | |
18 | ||
19 | /* scan through physical windows and convert address */ | |
20 | for (k = 0; k < d->nr_windows; k++) { | |
21 | window = d->window + k; | |
22 | ||
23 | if (address < window->phys) | |
24 | continue; | |
25 | ||
26 | if (address >= (window->phys + window->size)) | |
27 | continue; | |
28 | ||
29 | address -= window->phys; | |
30 | address += (unsigned long)window->virt; | |
31 | ||
32 | return address; | |
33 | } | |
34 | ||
35 | /* no windows defined, register must be 1:1 mapped virt:phys */ | |
36 | return address; | |
37 | } | |
38 | ||
39 | unsigned int intc_get_reg(struct intc_desc_int *d, unsigned long address) | |
40 | { | |
41 | unsigned int k; | |
42 | ||
43 | address = intc_phys_to_virt(d, address); | |
44 | ||
45 | for (k = 0; k < d->nr_reg; k++) { | |
46 | if (d->reg[k] == address) | |
47 | return k; | |
48 | } | |
49 | ||
50 | BUG(); | |
51 | return 0; | |
52 | } | |
53 | ||
54 | unsigned int intc_set_field_from_handle(unsigned int value, | |
55 | unsigned int field_value, | |
56 | unsigned int handle) | |
57 | { | |
58 | unsigned int width = _INTC_WIDTH(handle); | |
59 | unsigned int shift = _INTC_SHIFT(handle); | |
60 | ||
61 | value &= ~(((1 << width) - 1) << shift); | |
62 | value |= field_value << shift; | |
63 | return value; | |
64 | } | |
65 | ||
66 | unsigned long intc_get_field_from_handle(unsigned int value, unsigned int handle) | |
67 | { | |
68 | unsigned int width = _INTC_WIDTH(handle); | |
69 | unsigned int shift = _INTC_SHIFT(handle); | |
70 | unsigned int mask = ((1 << width) - 1) << shift; | |
71 | ||
72 | return (value & mask) >> shift; | |
73 | } | |
74 | ||
75 | static unsigned long test_8(unsigned long addr, unsigned long h, | |
76 | unsigned long ignore) | |
77 | { | |
0dd4d5cb PM |
78 | void __iomem *ptr = (void __iomem *)addr; |
79 | return intc_get_field_from_handle(__raw_readb(ptr), h); | |
2be6bb0c PM |
80 | } |
81 | ||
82 | static unsigned long test_16(unsigned long addr, unsigned long h, | |
83 | unsigned long ignore) | |
84 | { | |
0dd4d5cb PM |
85 | void __iomem *ptr = (void __iomem *)addr; |
86 | return intc_get_field_from_handle(__raw_readw(ptr), h); | |
2be6bb0c PM |
87 | } |
88 | ||
89 | static unsigned long test_32(unsigned long addr, unsigned long h, | |
90 | unsigned long ignore) | |
91 | { | |
0dd4d5cb PM |
92 | void __iomem *ptr = (void __iomem *)addr; |
93 | return intc_get_field_from_handle(__raw_readl(ptr), h); | |
2be6bb0c PM |
94 | } |
95 | ||
96 | static unsigned long write_8(unsigned long addr, unsigned long h, | |
97 | unsigned long data) | |
98 | { | |
0dd4d5cb PM |
99 | void __iomem *ptr = (void __iomem *)addr; |
100 | __raw_writeb(intc_set_field_from_handle(0, data, h), ptr); | |
101 | (void)__raw_readb(ptr); /* Defeat write posting */ | |
2be6bb0c PM |
102 | return 0; |
103 | } | |
104 | ||
105 | static unsigned long write_16(unsigned long addr, unsigned long h, | |
106 | unsigned long data) | |
107 | { | |
0dd4d5cb PM |
108 | void __iomem *ptr = (void __iomem *)addr; |
109 | __raw_writew(intc_set_field_from_handle(0, data, h), ptr); | |
110 | (void)__raw_readw(ptr); /* Defeat write posting */ | |
2be6bb0c PM |
111 | return 0; |
112 | } | |
113 | ||
114 | static unsigned long write_32(unsigned long addr, unsigned long h, | |
115 | unsigned long data) | |
116 | { | |
0dd4d5cb PM |
117 | void __iomem *ptr = (void __iomem *)addr; |
118 | __raw_writel(intc_set_field_from_handle(0, data, h), ptr); | |
119 | (void)__raw_readl(ptr); /* Defeat write posting */ | |
2be6bb0c PM |
120 | return 0; |
121 | } | |
122 | ||
123 | static unsigned long modify_8(unsigned long addr, unsigned long h, | |
124 | unsigned long data) | |
125 | { | |
0dd4d5cb | 126 | void __iomem *ptr = (void __iomem *)addr; |
2be6bb0c PM |
127 | unsigned long flags; |
128 | unsigned int value; | |
129 | local_irq_save(flags); | |
0dd4d5cb PM |
130 | value = intc_set_field_from_handle(__raw_readb(ptr), data, h); |
131 | __raw_writeb(value, ptr); | |
132 | (void)__raw_readb(ptr); /* Defeat write posting */ | |
2be6bb0c PM |
133 | local_irq_restore(flags); |
134 | return 0; | |
135 | } | |
136 | ||
137 | static unsigned long modify_16(unsigned long addr, unsigned long h, | |
138 | unsigned long data) | |
139 | { | |
0dd4d5cb | 140 | void __iomem *ptr = (void __iomem *)addr; |
2be6bb0c PM |
141 | unsigned long flags; |
142 | unsigned int value; | |
143 | local_irq_save(flags); | |
0dd4d5cb PM |
144 | value = intc_set_field_from_handle(__raw_readw(ptr), data, h); |
145 | __raw_writew(value, ptr); | |
146 | (void)__raw_readw(ptr); /* Defeat write posting */ | |
2be6bb0c PM |
147 | local_irq_restore(flags); |
148 | return 0; | |
149 | } | |
150 | ||
151 | static unsigned long modify_32(unsigned long addr, unsigned long h, | |
152 | unsigned long data) | |
153 | { | |
0dd4d5cb | 154 | void __iomem *ptr = (void __iomem *)addr; |
2be6bb0c PM |
155 | unsigned long flags; |
156 | unsigned int value; | |
157 | local_irq_save(flags); | |
0dd4d5cb PM |
158 | value = intc_set_field_from_handle(__raw_readl(ptr), data, h); |
159 | __raw_writel(value, ptr); | |
160 | (void)__raw_readl(ptr); /* Defeat write posting */ | |
2be6bb0c PM |
161 | local_irq_restore(flags); |
162 | return 0; | |
163 | } | |
164 | ||
165 | static unsigned long intc_mode_field(unsigned long addr, | |
166 | unsigned long handle, | |
167 | unsigned long (*fn)(unsigned long, | |
168 | unsigned long, | |
169 | unsigned long), | |
170 | unsigned int irq) | |
171 | { | |
172 | return fn(addr, handle, ((1 << _INTC_WIDTH(handle)) - 1)); | |
173 | } | |
174 | ||
175 | static unsigned long intc_mode_zero(unsigned long addr, | |
176 | unsigned long handle, | |
177 | unsigned long (*fn)(unsigned long, | |
178 | unsigned long, | |
179 | unsigned long), | |
180 | unsigned int irq) | |
181 | { | |
182 | return fn(addr, handle, 0); | |
183 | } | |
184 | ||
185 | static unsigned long intc_mode_prio(unsigned long addr, | |
186 | unsigned long handle, | |
187 | unsigned long (*fn)(unsigned long, | |
188 | unsigned long, | |
189 | unsigned long), | |
190 | unsigned int irq) | |
191 | { | |
192 | return fn(addr, handle, intc_get_prio_level(irq)); | |
193 | } | |
194 | ||
195 | unsigned long (*intc_reg_fns[])(unsigned long addr, | |
196 | unsigned long h, | |
197 | unsigned long data) = { | |
198 | [REG_FN_TEST_BASE + 0] = test_8, | |
199 | [REG_FN_TEST_BASE + 1] = test_16, | |
200 | [REG_FN_TEST_BASE + 3] = test_32, | |
201 | [REG_FN_WRITE_BASE + 0] = write_8, | |
202 | [REG_FN_WRITE_BASE + 1] = write_16, | |
203 | [REG_FN_WRITE_BASE + 3] = write_32, | |
204 | [REG_FN_MODIFY_BASE + 0] = modify_8, | |
205 | [REG_FN_MODIFY_BASE + 1] = modify_16, | |
206 | [REG_FN_MODIFY_BASE + 3] = modify_32, | |
207 | }; | |
208 | ||
209 | unsigned long (*intc_enable_fns[])(unsigned long addr, | |
210 | unsigned long handle, | |
211 | unsigned long (*fn)(unsigned long, | |
212 | unsigned long, | |
213 | unsigned long), | |
214 | unsigned int irq) = { | |
215 | [MODE_ENABLE_REG] = intc_mode_field, | |
216 | [MODE_MASK_REG] = intc_mode_zero, | |
217 | [MODE_DUAL_REG] = intc_mode_field, | |
218 | [MODE_PRIO_REG] = intc_mode_prio, | |
219 | [MODE_PCLR_REG] = intc_mode_prio, | |
220 | }; | |
221 | ||
222 | unsigned long (*intc_disable_fns[])(unsigned long addr, | |
223 | unsigned long handle, | |
224 | unsigned long (*fn)(unsigned long, | |
225 | unsigned long, | |
226 | unsigned long), | |
227 | unsigned int irq) = { | |
228 | [MODE_ENABLE_REG] = intc_mode_zero, | |
229 | [MODE_MASK_REG] = intc_mode_field, | |
230 | [MODE_DUAL_REG] = intc_mode_field, | |
231 | [MODE_PRIO_REG] = intc_mode_zero, | |
232 | [MODE_PCLR_REG] = intc_mode_field, | |
233 | }; | |
234 | ||
235 | unsigned long (*intc_enable_noprio_fns[])(unsigned long addr, | |
236 | unsigned long handle, | |
237 | unsigned long (*fn)(unsigned long, | |
238 | unsigned long, | |
239 | unsigned long), | |
240 | unsigned int irq) = { | |
241 | [MODE_ENABLE_REG] = intc_mode_field, | |
242 | [MODE_MASK_REG] = intc_mode_zero, | |
243 | [MODE_DUAL_REG] = intc_mode_field, | |
244 | [MODE_PRIO_REG] = intc_mode_field, | |
245 | [MODE_PCLR_REG] = intc_mode_field, | |
246 | }; |