1 /* 2 * PeeCeeI.c: The emerging standard... 3 * 4 * Copyright (C) 1997 David S. Miller (davem@caip.rutgers.edu) 5 */ 6 7 #include <asm/io.h> 8 #include <asm/byteorder.h> 9 10 void outsb(unsigned long __addr, const void *src, unsigned long count) 11 { 12 void __iomem *addr = (void __iomem *) __addr; 13 const u8 *p = src; 14 15 while (count--) 16 outb(*p++, addr); 17 } 18 19 void outsw(unsigned long __addr, const void *src, unsigned long count) 20 { 21 void __iomem *addr = (void __iomem *) __addr; 22 23 while (count--) { 24 __raw_writew(*(u16 *)src, addr); 25 src += sizeof(u16); 26 } 27 } 28 29 void outsl(unsigned long __addr, const void *src, unsigned long count) 30 { 31 void __iomem *addr = (void __iomem *) __addr; 32 u32 l, l2; 33 34 if (!count) 35 return; 36 37 switch (((unsigned long)src) & 0x3) { 38 case 0x0: 39 /* src is naturally aligned */ 40 while (count--) { 41 __raw_writel(*(u32 *)src, addr); 42 src += sizeof(u32); 43 } 44 break; 45 case 0x2: 46 /* 2-byte alignment */ 47 while (count--) { 48 l = (*(u16 *)src) << 16; 49 l |= *(u16 *)(src + sizeof(u16)); 50 __raw_writel(l, addr); 51 src += sizeof(u32); 52 } 53 break; 54 case 0x1: 55 /* Hold three bytes in l each time, grab a byte from l2 */ 56 l = (*(u8 *)src) << 24; 57 l |= (*(u16 *)(src + sizeof(u8))) << 8; 58 src += sizeof(u8) + sizeof(u16); 59 while (count--) { 60 l2 = *(u32 *)src; 61 l |= (l2 >> 24); 62 __raw_writel(l, addr); 63 l = l2 << 8; 64 src += sizeof(u32); 65 } 66 break; 67 case 0x3: 68 /* Hold a byte in l each time, grab 3 bytes from l2 */ 69 l = (*(u8 *)src) << 24; 70 src += sizeof(u8); 71 while (count--) { 72 l2 = *(u32 *)src; 73 l |= (l2 >> 8); 74 __raw_writel(l, addr); 75 l = l2 << 24; 76 src += sizeof(u32); 77 } 78 break; 79 } 80 } 81 82 void insb(unsigned long __addr, void *dst, unsigned long count) 83 { 84 void __iomem *addr = (void __iomem *) __addr; 85 86 if (count) { 87 u32 *pi; 88 u8 *pb = dst; 89 90 while ((((unsigned long)pb) & 0x3) && count--) 91 *pb++ = inb(addr); 92 pi = (u32 *)pb; 93 while (count >= 4) { 94 u32 w; 95 96 w = (inb(addr) << 24); 97 w |= (inb(addr) << 16); 98 w |= (inb(addr) << 8); 99 w |= (inb(addr) << 0); 100 *pi++ = w; 101 count -= 4; 102 } 103 pb = (u8 *)pi; 104 while (count--) 105 *pb++ = inb(addr); 106 } 107 } 108 109 void insw(unsigned long __addr, void *dst, unsigned long count) 110 { 111 void __iomem *addr = (void __iomem *) __addr; 112 113 if (count) { 114 u16 *ps = dst; 115 u32 *pi; 116 117 if (((unsigned long)ps) & 0x2) { 118 *ps++ = le16_to_cpu(inw(addr)); 119 count--; 120 } 121 pi = (u32 *)ps; 122 while (count >= 2) { 123 u32 w; 124 125 w = (le16_to_cpu(inw(addr)) << 16); 126 w |= (le16_to_cpu(inw(addr)) << 0); 127 *pi++ = w; 128 count -= 2; 129 } 130 ps = (u16 *)pi; 131 if (count) 132 *ps = le16_to_cpu(inw(addr)); 133 } 134 } 135 136 void insl(unsigned long __addr, void *dst, unsigned long count) 137 { 138 void __iomem *addr = (void __iomem *) __addr; 139 140 if (count) { 141 if ((((unsigned long)dst) & 0x3) == 0) { 142 u32 *pi = dst; 143 while (count--) 144 *pi++ = le32_to_cpu(inl(addr)); 145 } else { 146 u32 l = 0, l2, *pi; 147 u16 *ps; 148 u8 *pb; 149 150 switch (((unsigned long)dst) & 3) { 151 case 0x2: 152 ps = dst; 153 count -= 1; 154 l = le32_to_cpu(inl(addr)); 155 *ps++ = l; 156 pi = (u32 *)ps; 157 while (count--) { 158 l2 = le32_to_cpu(inl(addr)); 159 *pi++ = (l << 16) | (l2 >> 16); 160 l = l2; 161 } 162 ps = (u16 *)pi; 163 *ps = l; 164 break; 165 166 case 0x1: 167 pb = dst; 168 count -= 1; 169 l = le32_to_cpu(inl(addr)); 170 *pb++ = l >> 24; 171 ps = (u16 *)pb; 172 *ps++ = ((l >> 8) & 0xffff); 173 pi = (u32 *)ps; 174 while (count--) { 175 l2 = le32_to_cpu(inl(addr)); 176 *pi++ = (l << 24) | (l2 >> 8); 177 l = l2; 178 } 179 pb = (u8 *)pi; 180 *pb = l; 181 break; 182 183 case 0x3: 184 pb = (u8 *)dst; 185 count -= 1; 186 l = le32_to_cpu(inl(addr)); 187 *pb++ = l >> 24; 188 pi = (u32 *)pb; 189 while (count--) { 190 l2 = le32_to_cpu(inl(addr)); 191 *pi++ = (l << 8) | (l2 >> 24); 192 l = l2; 193 } 194 ps = (u16 *)pi; 195 *ps++ = ((l >> 8) & 0xffff); 196 pb = (u8 *)ps; 197 *pb = l; 198 break; 199 } 200 } 201 } 202 } 203 204