| 1 | /** | ||
| 2 | * @file bswap.h | ||
| 3 | * byte swap. | ||
| 4 | */ | ||
| 5 | |||
| 6 | #ifndef __BSWAP_H__ | ||
| 7 | #define __BSWAP_H__ | ||
| 8 | |||
| 9 | #ifdef HAVE_BYTESWAP_H | ||
| 10 | #include <byteswap.h> | ||
| 11 | #else | ||
| 12 | |||
| 13 | #ifdef ARCH_X86 | ||
| 14 | static inline unsigned short ByteSwap16(unsigned short x) | ||
| 15 | { | ||
| 16 | __asm("xchgb %b0,%h0" : | ||
| 17 | "=q" (x) : | ||
| 18 | "0" (x)); | ||
| 19 | return x; | ||
| 20 | } | ||
| 21 | #define bswap_16(x) ByteSwap16(x) | ||
| 22 | |||
| 23 | static inline unsigned int ByteSwap32(unsigned int x) | ||
| 24 | { | ||
| 25 | #if __CPU__ > 386 | ||
| 26 | __asm("bswap %0": | ||
| 27 | "=r" (x) : | ||
| 28 | #else | ||
| 29 | __asm("xchgb %b0,%h0\n" | ||
| 30 | " rorl $16,%0\n" | ||
| 31 | " xchgb %b0,%h0": | ||
| 32 | "=q" (x) : | ||
| 33 | #endif | ||
| 34 | "0" (x)); | ||
| 35 | return x; | ||
| 36 | } | ||
| 37 | #define bswap_32(x) ByteSwap32(x) | ||
| 38 | |||
| 39 | static inline unsigned long long int ByteSwap64(unsigned long long int x) | ||
| 40 | { | ||
| 41 | register union { __extension__ uint64_t __ll; | ||
| 42 | uint32_t __l[2]; } __x; | ||
| 43 | asm("xchgl %0,%1": | ||
| 44 | "=r"(__x.__l[0]),"=r"(__x.__l[1]): | ||
| 45 | "0"(bswap_32((unsigned long)x)),"1"(bswap_32((unsigned long)(x>>32)))); | ||
| 46 | return __x.__ll; | ||
| 47 | } | ||
| 48 | #define bswap_64(x) ByteSwap64(x) | ||
| 49 | |||
| 50 | #elif defined(ARCH_SH4) | ||
| 51 | |||
| 52 | static inline uint16_t ByteSwap16(uint16_t x) { | ||
| 53 | __asm__("swap.b %0,%0":"=r"(x):"0"(x)); | ||
| 54 | return x; | ||
| 55 | } | ||
| 56 | |||
| 57 | static inline uint32_t ByteSwap32(uint32_t x) { | ||
| 58 | __asm__( | ||
| 59 | "swap.b %0,%0\n" | ||
| 60 | "swap.w %0,%0\n" | ||
| 61 | "swap.b %0,%0\n" | ||
| 62 | :"=r"(x):"0"(x)); | ||
| 63 | return x; | ||
| 64 | } | ||
| 65 | |||
| 66 | #define bswap_16(x) ByteSwap16(x) | ||
| 67 | #define bswap_32(x) ByteSwap32(x) | ||
| 68 | |||
| 69 | static inline uint64_t ByteSwap64(uint64_t x) | ||
| 70 | { | ||
| 71 | union { | ||
| 72 | uint64_t ll; | ||
| 73 | struct { | ||
| 74 | uint32_t l,h; | ||
| 75 | } l; | ||
| 76 | } r; | ||
| 77 | r.l.l = bswap_32 (x); | ||
| 78 | r.l.h = bswap_32 (x>>32); | ||
| 79 | return r.ll; | ||
| 80 | } | ||
| 81 | #define bswap_64(x) ByteSwap64(x) | ||
| 82 | |||
| 83 | #else | ||
| 84 | // #include <stdint.h> | ||
| 85 | |||
| 86 | #define bswap_16(x) (((x) & 0x00ff) << 8 | ((x) & 0xff00) >> 8) | ||
| 87 | |||
| 88 | |||
| 89 | // code from bits/byteswap.h (C) 1997, 1998 Free Software Foundation, Inc. | ||
| 90 | #define bswap_32(x) \ | ||
| 91 | ((((x) & 0xff000000) >> 24) | (((x) & 0x00ff0000) >> 8) | \ | ||
| 92 | (((x) & 0x0000ff00) << 8) | (((x) & 0x000000ff) << 24)) | ||
| 93 | |||
| 94 | 0 | static inline uint64_t ByteSwap64(uint64_t x) | |
| 95 | { | ||
| 96 | union { | ||
| 97 | uint64_t ll; | ||
| 98 | uint32_t l[2]; | ||
| 99 | } w, r; | ||
| 100 | 0 | w.ll = x; | |
| 101 | 0 | r.l[0] = bswap_32 (w.l[1]); | |
| 102 | 0 | r.l[1] = bswap_32 (w.l[0]); | |
| 103 | 0 | return r.ll; | |
| 104 | } | ||
| 105 | #define bswap_64(x) ByteSwap64(x) | ||
| 106 | |||
| 107 | #endif /* !ARCH_X86 */ | ||
| 108 | |||
| 109 | #endif /* !HAVE_BYTESWAP_H */ | ||
| 110 | |||
| 111 | // be2me ... BigEndian to MachineEndian | ||
| 112 | // le2me ... LittleEndian to MachineEndian | ||
| 113 | |||
| 114 | #ifdef WORDS_BIGENDIAN | ||
| 115 | #define be2me_16(x) (x) | ||
| 116 | #define be2me_32(x) (x) | ||
| 117 | #define be2me_64(x) (x) | ||
| 118 | #define le2me_16(x) bswap_16(x) | ||
| 119 | #define le2me_32(x) bswap_32(x) | ||
| 120 | #define le2me_64(x) bswap_64(x) | ||
| 121 | #else | ||
| 122 | #define be2me_16(x) bswap_16(x) | ||
| 123 | #define be2me_32(x) bswap_32(x) | ||
| 124 | #define be2me_64(x) bswap_64(x) | ||
| 125 | #define le2me_16(x) (x) | ||
| 126 | #define le2me_32(x) (x) | ||
| 127 | #define le2me_64(x) (x) | ||
| 128 | #endif | ||
| 129 | |||
| 130 | #endif /* __BSWAP_H__ */ |