sh/intc/access.c

0001 /*
0002  * Common INTC2 register accessors
0003  *
0004  * Copyright (C) 2007, 2008 Magnus Damm
0005  * Copyright (C) 2009, 2010 Paul Mundt
0006  *
0007  * This file is subject to the terms and conditions of the GNU General Public
0008  * License.  See the file "COPYING" in the main directory of this archive
0009  * for more details.
0010  */
0011 #include <linux/io.h>
0012 #include "internals.h"
0013
0014 unsigned long intc_phys_to_virt(struct intc_desc_int *d, unsigned long address)
0015 {
0016     struct intc_window *window;
0017     int k;
0018
0019     /* scan through physical windows and convert address */
0020     for (k = 0; k < d->nr_windows; k++) {
0021         window = d->window + k;
0022
0023         if (address < window->phys)
0024             continue;
0025
0026         if (address >= (window->phys + window->size))
0027             continue;
0028
0029         address -= window->phys;
0030         address += (unsigned long)window->virt;
0031
0032         return address;
0033     }
0034
0035     /* no windows defined, register must be 1:1 mapped virt:phys */
0036     return address;
0037 }
0038
0039 unsigned int intc_get_reg(struct intc_desc_int *d, unsigned long address)
0040 {
0041     unsigned int k;
0042
0043     address = intc_phys_to_virt(d, address);
0044
0045     for (k = 0; k < d->nr_reg; k++) {
0046         if (d->reg[k] == address)
0047             return k;
0048     }
0049
0050     BUG();
0051     return 0;
0052 }
0053
0054 unsigned int intc_set_field_from_handle(unsigned int value,
0055                     unsigned int field_value,
0056                     unsigned int handle)
0057 {
0058     unsigned int width = _INTC_WIDTH(handle);
0059     unsigned int shift = _INTC_SHIFT(handle);
0060
0061     value &= ~(((1 << width) - 1) << shift);
0062     value |= field_value << shift;
0063     return value;
0064 }
0065
0066 unsigned long intc_get_field_from_handle(unsigned int value, unsigned int handle)
0067 {
0068     unsigned int width = _INTC_WIDTH(handle);
0069     unsigned int shift = _INTC_SHIFT(handle);
0070     unsigned int mask = ((1 << width) - 1) << shift;
0071
0072     return (value & mask) >> shift;
0073 }
0074
0075 static unsigned long test_8(unsigned long addr, unsigned long h,
0076                 unsigned long ignore)
0077 {
0078     void __iomem *ptr = (void __iomem *)addr;
0079     return intc_get_field_from_handle(__raw_readb(ptr), h);
0080 }
0081
0082 static unsigned long test_16(unsigned long addr, unsigned long h,
0083                  unsigned long ignore)
0084 {
0085     void __iomem *ptr = (void __iomem *)addr;
0086     return intc_get_field_from_handle(__raw_readw(ptr), h);
0087 }
0088
0089 static unsigned long test_32(unsigned long addr, unsigned long h,
0090                  unsigned long ignore)
0091 {
0092     void __iomem *ptr = (void __iomem *)addr;
0093     return intc_get_field_from_handle(__raw_readl(ptr), h);
0094 }
0095
0096 static unsigned long write_8(unsigned long addr, unsigned long h,
0097                  unsigned long data)
0098 {
0099     void __iomem *ptr = (void __iomem *)addr;
0100     __raw_writeb(intc_set_field_from_handle(0, data, h), ptr);
0101     (void)__raw_readb(ptr); /* Defeat write posting */
0102     return 0;
0103 }
0104
0105 static unsigned long write_16(unsigned long addr, unsigned long h,
0106                   unsigned long data)
0107 {
0108     void __iomem *ptr = (void __iomem *)addr;
0109     __raw_writew(intc_set_field_from_handle(0, data, h), ptr);
0110     (void)__raw_readw(ptr); /* Defeat write posting */
0111     return 0;
0112 }
0113
0114 static unsigned long write_32(unsigned long addr, unsigned long h,
0115                   unsigned long data)
0116 {
0117     void __iomem *ptr = (void __iomem *)addr;
0118     __raw_writel(intc_set_field_from_handle(0, data, h), ptr);
0119     (void)__raw_readl(ptr); /* Defeat write posting */
0120     return 0;
0121 }
0122
0123 static unsigned long modify_8(unsigned long addr, unsigned long h,
0124                   unsigned long data)
0125 {
0126     void __iomem *ptr = (void __iomem *)addr;
0127     unsigned long flags;
0128     unsigned int value;
0129     local_irq_save(flags);
0130     value = intc_set_field_from_handle(__raw_readb(ptr), data, h);
0131     __raw_writeb(value, ptr);
0132     (void)__raw_readb(ptr); /* Defeat write posting */
0133     local_irq_restore(flags);
0134     return 0;
0135 }
0136
0137 static unsigned long modify_16(unsigned long addr, unsigned long h,
0138                    unsigned long data)
0139 {
0140     void __iomem *ptr = (void __iomem *)addr;
0141     unsigned long flags;
0142     unsigned int value;
0143     local_irq_save(flags);
0144     value = intc_set_field_from_handle(__raw_readw(ptr), data, h);
0145     __raw_writew(value, ptr);
0146     (void)__raw_readw(ptr); /* Defeat write posting */
0147     local_irq_restore(flags);
0148     return 0;
0149 }
0150
0151 static unsigned long modify_32(unsigned long addr, unsigned long h,
0152                    unsigned long data)
0153 {
0154     void __iomem *ptr = (void __iomem *)addr;
0155     unsigned long flags;
0156     unsigned int value;
0157     local_irq_save(flags);
0158     value = intc_set_field_from_handle(__raw_readl(ptr), data, h);
0159     __raw_writel(value, ptr);
0160     (void)__raw_readl(ptr); /* Defeat write posting */
0161     local_irq_restore(flags);
0162     return 0;
0163 }
0164
0165 static unsigned long intc_mode_field(unsigned long addr,
0166                      unsigned long handle,
0167                      unsigned long (*fn)(unsigned long,
0168                         unsigned long,
0169                         unsigned long),
0170                      unsigned int irq)
0171 {
0172     return fn(addr, handle, ((1 << _INTC_WIDTH(handle)) - 1));
0173 }
0174
0175 static unsigned long intc_mode_zero(unsigned long addr,
0176                     unsigned long handle,
0177                     unsigned long (*fn)(unsigned long,
0178                            unsigned long,
0179                            unsigned long),
0180                     unsigned int irq)
0181 {
0182     return fn(addr, handle, 0);
0183 }
0184
0185 static unsigned long intc_mode_prio(unsigned long addr,
0186                     unsigned long handle,
0187                     unsigned long (*fn)(unsigned long,
0188                            unsigned long,
0189                            unsigned long),
0190                     unsigned int irq)
0191 {
0192     return fn(addr, handle, intc_get_prio_level(irq));
0193 }
0194
0195 unsigned long (*intc_reg_fns[])(unsigned long addr,
0196                 unsigned long h,
0197                 unsigned long data) = {
0198     [REG_FN_TEST_BASE + 0] = test_8,
0199     [REG_FN_TEST_BASE + 1] = test_16,
0200     [REG_FN_TEST_BASE + 3] = test_32,
0201     [REG_FN_WRITE_BASE + 0] = write_8,
0202     [REG_FN_WRITE_BASE + 1] = write_16,
0203     [REG_FN_WRITE_BASE + 3] = write_32,
0204     [REG_FN_MODIFY_BASE + 0] = modify_8,
0205     [REG_FN_MODIFY_BASE + 1] = modify_16,
0206     [REG_FN_MODIFY_BASE + 3] = modify_32,
0207 };
0208
0209 unsigned long (*intc_enable_fns[])(unsigned long addr,
0210                    unsigned long handle,
0211                    unsigned long (*fn)(unsigned long,
0212                         unsigned long,
0213                         unsigned long),
0214                    unsigned int irq) = {
0215     [MODE_ENABLE_REG] = intc_mode_field,
0216     [MODE_MASK_REG] = intc_mode_zero,
0217     [MODE_DUAL_REG] = intc_mode_field,
0218     [MODE_PRIO_REG] = intc_mode_prio,
0219     [MODE_PCLR_REG] = intc_mode_prio,
0220 };
0221
0222 unsigned long (*intc_disable_fns[])(unsigned long addr,
0223                     unsigned long handle,
0224                     unsigned long (*fn)(unsigned long,
0225                          unsigned long,
0226                          unsigned long),
0227                     unsigned int irq) = {
0228     [MODE_ENABLE_REG] = intc_mode_zero,
0229     [MODE_MASK_REG] = intc_mode_field,
0230     [MODE_DUAL_REG] = intc_mode_field,
0231     [MODE_PRIO_REG] = intc_mode_zero,
0232     [MODE_PCLR_REG] = intc_mode_field,
0233 };
0234
0235 unsigned long (*intc_enable_noprio_fns[])(unsigned long addr,
0236                       unsigned long handle,
0237                       unsigned long (*fn)(unsigned long,
0238                         unsigned long,
0239                         unsigned long),
0240                       unsigned int irq) = {
0241     [MODE_ENABLE_REG] = intc_mode_field,
0242     [MODE_MASK_REG] = intc_mode_zero,
0243     [MODE_DUAL_REG] = intc_mode_field,
0244     [MODE_PRIO_REG] = intc_mode_field,
0245     [MODE_PCLR_REG] = intc_mode_field,
0246 };