diff --git a/arch/parisc/lib/iomap.c b/arch/parisc/lib/iomap.c index 290a62e7120b7810ca29982a902c01fbbc34dd40..01bec8fcbd0d180b120cc4995fe8b0aaf5b14025 100644 --- a/arch/parisc/lib/iomap.c +++ b/arch/parisc/lib/iomap.c @@ -43,10 +43,14 @@ struct iomap_ops { unsigned int (*read8)(void __iomem *); unsigned int (*read16)(void __iomem *); + unsigned int (*read16be)(void __iomem *); unsigned int (*read32)(void __iomem *); + unsigned int (*read32be)(void __iomem *); void (*write8)(u8, void __iomem *); void (*write16)(u16, void __iomem *); + void (*write16be)(u16, void __iomem *); void (*write32)(u32, void __iomem *); + void (*write32be)(u32, void __iomem *); void (*read8r)(void __iomem *, void *, unsigned long); void (*read16r)(void __iomem *, void *, unsigned long); void (*read32r)(void __iomem *, void *, unsigned long); @@ -122,9 +126,13 @@ static void ioport_write32r(void __iomem *addr, const void *s, unsigned long n) static const struct iomap_ops ioport_ops = { ioport_read8, ioport_read16, + ioport_read16, + ioport_read32, ioport_read32, ioport_write8, ioport_write16, + ioport_write16, + ioport_write32, ioport_write32, ioport_read8r, ioport_read16r, @@ -146,11 +154,21 @@ static unsigned int iomem_read16(void __iomem *addr) return readw(addr); } +static unsigned int iomem_read16be(void __iomem *addr) +{ + return __raw_readw(addr); +} + static unsigned int iomem_read32(void __iomem *addr) { return readl(addr); } +static unsigned int iomem_read32be(void __iomem *addr) +{ + return __raw_readl(addr); +} + static void iomem_write8(u8 datum, void __iomem *addr) { writeb(datum, addr); @@ -161,11 +179,21 @@ static void iomem_write16(u16 datum, void __iomem *addr) writew(datum, addr); } +static void iomem_write16be(u16 datum, void __iomem *addr) +{ + __raw_writew(datum, addr); +} + static void iomem_write32(u32 datum, void __iomem *addr) { writel(datum, addr); } +static void iomem_write32be(u32 datum, void __iomem *addr) +{ + __raw_writel(datum, addr); +} + static void iomem_read8r(void __iomem *addr, void *dst, unsigned long count) { while (count--) { @@ -217,10 +245,14 @@ static void iomem_write32r(void __iomem *addr, const void *s, unsigned long n) static const struct iomap_ops iomem_ops = { iomem_read8, iomem_read16, + iomem_read16be, iomem_read32, + iomem_read32be, iomem_write8, iomem_write16, + iomem_write16be, iomem_write32, + iomem_write32be, iomem_read8r, iomem_read16r, iomem_read32r, @@ -253,6 +285,13 @@ unsigned int ioread16(void __iomem *addr) return le16_to_cpup((u16 *)addr); } +unsigned int ioread16be(void __iomem *addr) +{ + if (unlikely(INDIRECT_ADDR(addr))) + return iomap_ops[ADDR_TO_REGION(addr)]->read16be(addr); + return *((u16 *)addr); +} + unsigned int ioread32(void __iomem *addr) { if (unlikely(INDIRECT_ADDR(addr))) @@ -260,6 +299,13 @@ unsigned int ioread32(void __iomem *addr) return le32_to_cpup((u32 *)addr); } +unsigned int ioread32be(void __iomem *addr) +{ + if (unlikely(INDIRECT_ADDR(addr))) + return iomap_ops[ADDR_TO_REGION(addr)]->read32be(addr); + return *((u32 *)addr); +} + void iowrite8(u8 datum, void __iomem *addr) { if (unlikely(INDIRECT_ADDR(addr))) { @@ -278,6 +324,15 @@ void iowrite16(u16 datum, void __iomem *addr) } } +void iowrite16be(u16 datum, void __iomem *addr) +{ + if (unlikely(INDIRECT_ADDR(addr))) { + iomap_ops[ADDR_TO_REGION(addr)]->write16be(datum, addr); + } else { + *((u16 *)addr) = datum; + } +} + void iowrite32(u32 datum, void __iomem *addr) { if (unlikely(INDIRECT_ADDR(addr))) { @@ -287,6 +342,15 @@ void iowrite32(u32 datum, void __iomem *addr) } } +void iowrite32be(u32 datum, void __iomem *addr) +{ + if (unlikely(INDIRECT_ADDR(addr))) { + iomap_ops[ADDR_TO_REGION(addr)]->write32be(datum, addr); + } else { + *((u32 *)addr) = datum; + } +} + /* Repeating interfaces */ void ioread8_rep(void __iomem *addr, void *dst, unsigned long count) @@ -406,10 +470,14 @@ void pci_iounmap(struct pci_dev *dev, void __iomem * addr) EXPORT_SYMBOL(ioread8); EXPORT_SYMBOL(ioread16); +EXPORT_SYMBOL(ioread16be); EXPORT_SYMBOL(ioread32); +EXPORT_SYMBOL(ioread32be); EXPORT_SYMBOL(iowrite8); EXPORT_SYMBOL(iowrite16); +EXPORT_SYMBOL(iowrite16be); EXPORT_SYMBOL(iowrite32); +EXPORT_SYMBOL(iowrite32be); EXPORT_SYMBOL(ioread8_rep); EXPORT_SYMBOL(ioread16_rep); EXPORT_SYMBOL(ioread32_rep); diff --git a/include/asm-generic/iomap.h b/include/asm-generic/iomap.h index 4991543d44c8aeb430b0d0dd57ae3d2c786a23ae..cde592fca441824f23869d55617e36b58438c979 100644 --- a/include/asm-generic/iomap.h +++ b/include/asm-generic/iomap.h @@ -2,6 +2,7 @@ #define __GENERIC_IO_H #include +#include /* * These are the "generic" interfaces for doing new-style @@ -26,11 +27,15 @@ */ extern unsigned int fastcall ioread8(void __iomem *); extern unsigned int fastcall ioread16(void __iomem *); +extern unsigned int fastcall ioread16be(void __iomem *); extern unsigned int fastcall ioread32(void __iomem *); +extern unsigned int fastcall ioread32be(void __iomem *); extern void fastcall iowrite8(u8, void __iomem *); extern void fastcall iowrite16(u16, void __iomem *); +extern void fastcall iowrite16be(u16, void __iomem *); extern void fastcall iowrite32(u32, void __iomem *); +extern void fastcall iowrite32be(u32, void __iomem *); /* * "string" versions of the above. Note that they diff --git a/lib/iomap.c b/lib/iomap.c index 5e74390852b0dfc1d7d48ef42158160f7ea9a89c..55689c5d3379dbde2013f8cf3509bef6e9d74598 100644 --- a/lib/iomap.c +++ b/lib/iomap.c @@ -58,13 +58,23 @@ unsigned int fastcall ioread16(void __iomem *addr) { IO_COND(addr, return inw(port), return readw(addr)); } +unsigned int fastcall ioread16be(void __iomem *addr) +{ + IO_COND(addr, return inw(port), return be16_to_cpu(__raw_readw(addr))); +} unsigned int fastcall ioread32(void __iomem *addr) { IO_COND(addr, return inl(port), return readl(addr)); } +unsigned int fastcall ioread32be(void __iomem *addr) +{ + IO_COND(addr, return inl(port), return be32_to_cpu(__raw_readl(addr))); +} EXPORT_SYMBOL(ioread8); EXPORT_SYMBOL(ioread16); +EXPORT_SYMBOL(ioread16be); EXPORT_SYMBOL(ioread32); +EXPORT_SYMBOL(ioread32be); void fastcall iowrite8(u8 val, void __iomem *addr) { @@ -74,13 +84,23 @@ void fastcall iowrite16(u16 val, void __iomem *addr) { IO_COND(addr, outw(val,port), writew(val, addr)); } +void fastcall iowrite16be(u16 val, void __iomem *addr) +{ + IO_COND(addr, outw(val,port), __raw_writew(cpu_to_be16(val), addr)); +} void fastcall iowrite32(u32 val, void __iomem *addr) { IO_COND(addr, outl(val,port), writel(val, addr)); } +void fastcall iowrite32be(u32 val, void __iomem *addr) +{ + IO_COND(addr, outl(val,port), __raw_writel(cpu_to_be32(val), addr)); +} EXPORT_SYMBOL(iowrite8); EXPORT_SYMBOL(iowrite16); +EXPORT_SYMBOL(iowrite16be); EXPORT_SYMBOL(iowrite32); +EXPORT_SYMBOL(iowrite32be); /* * These are the "repeat MMIO read/write" functions.