]>
git.proxmox.com Git - mirror_ubuntu-artful-kernel.git/blob - drivers/sh/intc/access.c
2 * Common INTC2 register accessors
4 * Copyright (C) 2007, 2008 Magnus Damm
5 * Copyright (C) 2009, 2010 Paul Mundt
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
12 #include "internals.h"
14 unsigned long intc_phys_to_virt(struct intc_desc_int
*d
, unsigned long address
)
16 struct intc_window
*window
;
19 /* scan through physical windows and convert address */
20 for (k
= 0; k
< d
->nr_windows
; k
++) {
21 window
= d
->window
+ k
;
23 if (address
< window
->phys
)
26 if (address
>= (window
->phys
+ window
->size
))
29 address
-= window
->phys
;
30 address
+= (unsigned long)window
->virt
;
35 /* no windows defined, register must be 1:1 mapped virt:phys */
39 unsigned int intc_get_reg(struct intc_desc_int
*d
, unsigned long address
)
43 address
= intc_phys_to_virt(d
, address
);
45 for (k
= 0; k
< d
->nr_reg
; k
++) {
46 if (d
->reg
[k
] == address
)
54 unsigned int intc_set_field_from_handle(unsigned int value
,
55 unsigned int field_value
,
58 unsigned int width
= _INTC_WIDTH(handle
);
59 unsigned int shift
= _INTC_SHIFT(handle
);
61 value
&= ~(((1 << width
) - 1) << shift
);
62 value
|= field_value
<< shift
;
66 unsigned long intc_get_field_from_handle(unsigned int value
, unsigned int handle
)
68 unsigned int width
= _INTC_WIDTH(handle
);
69 unsigned int shift
= _INTC_SHIFT(handle
);
70 unsigned int mask
= ((1 << width
) - 1) << shift
;
72 return (value
& mask
) >> shift
;
75 static unsigned long test_8(unsigned long addr
, unsigned long h
,
78 void __iomem
*ptr
= (void __iomem
*)addr
;
79 return intc_get_field_from_handle(__raw_readb(ptr
), h
);
82 static unsigned long test_16(unsigned long addr
, unsigned long h
,
85 void __iomem
*ptr
= (void __iomem
*)addr
;
86 return intc_get_field_from_handle(__raw_readw(ptr
), h
);
89 static unsigned long test_32(unsigned long addr
, unsigned long h
,
92 void __iomem
*ptr
= (void __iomem
*)addr
;
93 return intc_get_field_from_handle(__raw_readl(ptr
), h
);
96 static unsigned long write_8(unsigned long addr
, unsigned long h
,
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 */
105 static unsigned long write_16(unsigned long addr
, unsigned long h
,
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 */
114 static unsigned long write_32(unsigned long addr
, unsigned long h
,
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 */
123 static unsigned long modify_8(unsigned long addr
, unsigned long h
,
126 void __iomem
*ptr
= (void __iomem
*)addr
;
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
);
137 static unsigned long modify_16(unsigned long addr
, unsigned long h
,
140 void __iomem
*ptr
= (void __iomem
*)addr
;
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
);
151 static unsigned long modify_32(unsigned long addr
, unsigned long h
,
154 void __iomem
*ptr
= (void __iomem
*)addr
;
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
);
165 static unsigned long intc_mode_field(unsigned long addr
,
166 unsigned long handle
,
167 unsigned long (*fn
)(unsigned long,
172 return fn(addr
, handle
, ((1 << _INTC_WIDTH(handle
)) - 1));
175 static unsigned long intc_mode_zero(unsigned long addr
,
176 unsigned long handle
,
177 unsigned long (*fn
)(unsigned long,
182 return fn(addr
, handle
, 0);
185 static unsigned long intc_mode_prio(unsigned long addr
,
186 unsigned long handle
,
187 unsigned long (*fn
)(unsigned long,
192 return fn(addr
, handle
, intc_get_prio_level(irq
));
195 unsigned long (*intc_reg_fns
[])(unsigned long addr
,
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
,
209 unsigned long (*intc_enable_fns
[])(unsigned long addr
,
210 unsigned long handle
,
211 unsigned long (*fn
)(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
,
222 unsigned long (*intc_disable_fns
[])(unsigned long addr
,
223 unsigned long handle
,
224 unsigned long (*fn
)(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
,
235 unsigned long (*intc_enable_noprio_fns
[])(unsigned long addr
,
236 unsigned long handle
,
237 unsigned long (*fn
)(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
,