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
14unsigned 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
39unsigned 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
54unsigned 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
66unsigned 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
75static unsigned long test_8(unsigned long addr, unsigned long h,
76			    unsigned long ignore)
77{
78	void __iomem *ptr = (void __iomem *)addr;
79	return intc_get_field_from_handle(__raw_readb(ptr), h);
80}
81
82static unsigned long test_16(unsigned long addr, unsigned long h,
83			     unsigned long ignore)
84{
85	void __iomem *ptr = (void __iomem *)addr;
86	return intc_get_field_from_handle(__raw_readw(ptr), h);
87}
88
89static unsigned long test_32(unsigned long addr, unsigned long h,
90			     unsigned long ignore)
91{
92	void __iomem *ptr = (void __iomem *)addr;
93	return intc_get_field_from_handle(__raw_readl(ptr), h);
94}
95
96static unsigned long write_8(unsigned long addr, unsigned long h,
97			     unsigned long data)
98{
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 */
102	return 0;
103}
104
105static unsigned long write_16(unsigned long addr, unsigned long h,
106			      unsigned long data)
107{
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 */
111	return 0;
112}
113
114static unsigned long write_32(unsigned long addr, unsigned long h,
115			      unsigned long data)
116{
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 */
120	return 0;
121}
122
123static unsigned long modify_8(unsigned long addr, unsigned long h,
124			      unsigned long data)
125{
126	void __iomem *ptr = (void __iomem *)addr;
127	unsigned long flags;
128	unsigned int value;
129	local_irq_save(flags);
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 */
133	local_irq_restore(flags);
134	return 0;
135}
136
137static unsigned long modify_16(unsigned long addr, unsigned long h,
138			       unsigned long data)
139{
140	void __iomem *ptr = (void __iomem *)addr;
141	unsigned long flags;
142	unsigned int value;
143	local_irq_save(flags);
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 */
147	local_irq_restore(flags);
148	return 0;
149}
150
151static unsigned long modify_32(unsigned long addr, unsigned long h,
152			       unsigned long data)
153{
154	void __iomem *ptr = (void __iomem *)addr;
155	unsigned long flags;
156	unsigned int value;
157	local_irq_save(flags);
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 */
161	local_irq_restore(flags);
162	return 0;
163}
164
165static 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
175static 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
185static 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
195unsigned 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
209unsigned 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
222unsigned 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
235unsigned 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};
247