target/linux/mpc83xx/patches-3.3/201-powerpc-add-rb_iomap.patch

   1 --- a/arch/powerpc/kernel/Makefile
   2 +++ b/arch/powerpc/kernel/Makefile
   3 @@ -125,9 +125,11 @@ obj-$(CONFIG_FSL_EMB_PERF_EVENT_E500) +=
   4
   5  obj-$(CONFIG_8XX_MINIMAL_FPEMU) += softemu8xx.o
   6
   7 +ifneq ($(CONFIG_RB_IOMAP),y)
   8  ifneq ($(CONFIG_PPC_INDIRECT_IO),y)
   9  obj-y                          += iomap.o
  10  endif
  11 +endif
  12
  13  obj-$(CONFIG_PPC64)            += $(obj64-y)
  14  obj-$(CONFIG_PPC32)            += $(obj32-y)
  15 --- a/arch/powerpc/platforms/83xx/Makefile
  16 +++ b/arch/powerpc/platforms/83xx/Makefile
  17 @@ -7,6 +7,7 @@ obj-$(CONFIG_MCU_MPC8349EMITX)  += mcu_mp
  18  obj-$(CONFIG_MPC830x_RDB)      += mpc830x_rdb.o
  19  obj-$(CONFIG_MPC831x_RDB)      += mpc831x_rdb.o
  20  obj-$(CONFIG_MPC832x_RDB)      += mpc832x_rdb.o
  21 +obj-$(CONFIG_RB_PPC)           += rbppc.o
  22  obj-$(CONFIG_MPC834x_MDS)      += mpc834x_mds.o
  23  obj-$(CONFIG_MPC834x_ITX)      += mpc834x_itx.o
  24  obj-$(CONFIG_MPC836x_MDS)      += mpc836x_mds.o
  25 --- a/arch/powerpc/platforms/Kconfig
  26 +++ b/arch/powerpc/platforms/Kconfig
  27 @@ -175,6 +175,10 @@ config PPC_INDIRECT_MMIO
  28  config PPC_IO_WORKAROUNDS
  29         bool
  30
  31 +config RB_IOMAP
  32 +       bool
  33 +       default y if RB_PPC
  34 +
  35  source "drivers/cpufreq/Kconfig"
  36
  37  menu "CPU Frequency drivers"
  38 --- a/arch/powerpc/sysdev/Makefile
  39 +++ b/arch/powerpc/sysdev/Makefile
  40 @@ -65,3 +65,5 @@ obj-$(CONFIG_PPC_SCOM)                += scom.o
  41  subdir-ccflags-$(CONFIG_PPC_WERROR) := -Werror
  42
  43  obj-$(CONFIG_PPC_XICS)         += xics/
  44 +
  45 +obj-$(CONFIG_RB_IOMAP)         += rb_iomap.o
  46 --- /dev/null
  47 +++ b/arch/powerpc/sysdev/rb_iomap.c
  48 @@ -0,0 +1,204 @@
  49 +#include <linux/init.h>
  50 +#include <linux/pci.h>
  51 +#include <linux/mm.h>
  52 +#include <asm/io.h>
  53 +
  54 +#define LOCALBUS_START         0x40000000
  55 +#define LOCALBUS_MASK          0x007fffff
  56 +#define LOCALBUS_REGMASK       0x001fffff
  57 +
  58 +static void __iomem *localbus_base;
  59 +
  60 +static inline int is_localbus(void __iomem *addr)
  61 +{
  62 +       return ((unsigned) addr & ~LOCALBUS_MASK) == LOCALBUS_START;
  63 +}
  64 +
  65 +static inline unsigned localbus_regoff(unsigned reg) {
  66 +       return (reg << 16) | (((reg ^ 8) & 8) << 17);
  67 +}
  68 +
  69 +static inline void __iomem *localbus_addr(void __iomem *addr)
  70 +{
  71 +       return localbus_base
  72 +           + ((unsigned) addr & LOCALBUS_MASK & ~LOCALBUS_REGMASK)
  73 +           + localbus_regoff((unsigned) addr & LOCALBUS_REGMASK);
  74 +}
  75 +
  76 +unsigned int ioread8(void __iomem *addr)
  77 +{
  78 +       if (is_localbus(addr))
  79 +               return in_be16(localbus_addr(addr)) >> 8;
  80 +       return readb(addr);
  81 +}
  82 +EXPORT_SYMBOL(ioread8);
  83 +
  84 +unsigned int ioread16(void __iomem *addr)
  85 +{
  86 +       if (is_localbus(addr))
  87 +               return le16_to_cpu(in_be16(localbus_addr(addr)));
  88 +       return readw(addr);
  89 +}
  90 +EXPORT_SYMBOL(ioread16);
  91 +
  92 +unsigned int ioread16be(void __iomem *addr)
  93 +{
  94 +       return in_be16(addr);
  95 +}
  96 +EXPORT_SYMBOL(ioread16be);
  97 +
  98 +unsigned int ioread32(void __iomem *addr)
  99 +{
 100 +       return readl(addr);
 101 +}
 102 +EXPORT_SYMBOL(ioread32);
 103 +
 104 +unsigned int ioread32be(void __iomem *addr)
 105 +{
 106 +       return in_be32(addr);
 107 +}
 108 +EXPORT_SYMBOL(ioread32be);
 109 +
 110 +void iowrite8(u8 val, void __iomem *addr)
 111 +{
 112 +       if (is_localbus(addr))
 113 +               out_be16(localbus_addr(addr), ((u16) val) << 8);
 114 +       else
 115 +               writeb(val, addr);
 116 +}
 117 +EXPORT_SYMBOL(iowrite8);
 118 +
 119 +void iowrite16(u16 val, void __iomem *addr)
 120 +{
 121 +       if (is_localbus(addr))
 122 +               out_be16(localbus_addr(addr), cpu_to_le16(val));
 123 +       else
 124 +               writew(val, addr);
 125 +}
 126 +EXPORT_SYMBOL(iowrite16);
 127 +
 128 +void iowrite16be(u16 val, void __iomem *addr)
 129 +{
 130 +       out_be16(addr, val);
 131 +}
 132 +EXPORT_SYMBOL(iowrite16be);
 133 +
 134 +void iowrite32(u32 val, void __iomem *addr)
 135 +{
 136 +       writel(val, addr);
 137 +}
 138 +EXPORT_SYMBOL(iowrite32);
 139 +
 140 +void iowrite32be(u32 val, void __iomem *addr)
 141 +{
 142 +       out_be32(addr, val);
 143 +}
 144 +EXPORT_SYMBOL(iowrite32be);
 145 +
 146 +void ioread8_rep(void __iomem *addr, void *dst, unsigned long count)
 147 +{
 148 +       if (is_localbus(addr)) {
 149 +               unsigned i;
 150 +               void *laddr = localbus_addr(addr);
 151 +               u8 *buf = dst;
 152 +
 153 +               for (i = 0; i < count; ++i) {
 154 +                       *buf++ = in_be16(laddr) >> 8;
 155 +               }
 156 +       } else {
 157 +               _insb((u8 __iomem *) addr, dst, count);
 158 +       }
 159 +}
 160 +EXPORT_SYMBOL(ioread8_rep);
 161 +
 162 +void ioread16_rep(void __iomem *addr, void *dst, unsigned long count)
 163 +{
 164 +       if (is_localbus(addr)) {
 165 +               unsigned i;
 166 +               void *laddr = localbus_addr(addr);
 167 +               u16 *buf = dst;
 168 +
 169 +               for (i = 0; i < count; ++i) {
 170 +                       *buf++ = in_be16(laddr);
 171 +               }
 172 +       } else {
 173 +               _insw_ns((u16 __iomem *) addr, dst, count);
 174 +       }
 175 +}
 176 +EXPORT_SYMBOL(ioread16_rep);
 177 +
 178 +void ioread32_rep(void __iomem *addr, void *dst, unsigned long count)
 179 +{
 180 +       _insl_ns((u32 __iomem *) addr, dst, count);
 181 +}
 182 +EXPORT_SYMBOL(ioread32_rep);
 183 +
 184 +void iowrite8_rep(void __iomem *addr, const void *src, unsigned long count)
 185 +{
 186 +       if (is_localbus(addr)) {
 187 +               unsigned i;
 188 +               void *laddr = localbus_addr(addr);
 189 +               const u8 *buf = src;
 190 +
 191 +               for (i = 0; i < count; ++i) {
 192 +                       out_be16(laddr, ((u16) *buf++) << 8);
 193 +               }
 194 +       } else {
 195 +               _outsb((u8 __iomem *) addr, src, count);
 196 +       }
 197 +}
 198 +EXPORT_SYMBOL(iowrite8_rep);
 199 +
 200 +void iowrite16_rep(void __iomem *addr, const void *src, unsigned long count)
 201 +{
 202 +       if (is_localbus(addr)) {
 203 +               unsigned i;
 204 +               void *laddr = localbus_addr(addr);
 205 +               const u16 *buf = src;
 206 +
 207 +               for (i = 0; i < count; ++i) {
 208 +                       out_be16(laddr, *buf++);
 209 +               }
 210 +       } else {
 211 +               _outsw_ns((u16 __iomem *) addr, src, count);
 212 +       }
 213 +}
 214 +EXPORT_SYMBOL(iowrite16_rep);
 215 +
 216 +void iowrite32_rep(void __iomem *addr, const void *src, unsigned long count)
 217 +{
 218 +       _outsl_ns((u32 __iomem *) addr, src, count);
 219 +}
 220 +EXPORT_SYMBOL(iowrite32_rep);
 221 +
 222 +void __iomem *ioport_map(unsigned long port, unsigned int len)
 223 +{
 224 +       return (void __iomem *) (port + _IO_BASE);
 225 +}
 226 +EXPORT_SYMBOL(ioport_unmap);
 227 +
 228 +void ioport_unmap(void __iomem *addr)
 229 +{
 230 +       /* Nothing to do */
 231 +}
 232 +EXPORT_SYMBOL(ioport_map);
 233 +
 234 +void pci_iounmap(struct pci_dev *dev, void __iomem *addr)
 235 +{
 236 +       /* Nothing to do */
 237 +}
 238 +EXPORT_SYMBOL(pci_iounmap);
 239 +
 240 +void __iomem *localbus_map(unsigned long addr, unsigned int len)
 241 +{
 242 +       if (!localbus_base)
 243 +               localbus_base = ioremap(addr & ~LOCALBUS_MASK,
 244 +                                       LOCALBUS_MASK + 1);
 245 +       return (void *) (LOCALBUS_START + (addr & LOCALBUS_MASK));
 246 +}
 247 +EXPORT_SYMBOL(localbus_map);
 248 +
 249 +void localbus_unmap(void __iomem *addr)
 250 +{
 251 +}
 252 +EXPORT_SYMBOL(localbus_unmap);
 253 --- a/arch/powerpc/platforms/83xx/Kconfig
 254 +++ b/arch/powerpc/platforms/83xx/Kconfig
 255 @@ -44,6 +44,7 @@ config RB_PPC
 256         select QUICC_ENGINE
 257         select PPC_MPC832x
 258         select PPC_MPC834x
 259 +       select RB_IOMAP
 260         help
 261           This option enables support for MikroTik RouterBOARD 333/600 series boards.
 262