72 lines
2.0 KiB
C
72 lines
2.0 KiB
C
#include <stdint.h>
|
|
|
|
// byteswappings
|
|
|
|
#define SWAP16(x) ({ uint16_t y=(x); (((y)>>8 & 0xff) | ((y)<<8 & 0xff00)); })
|
|
#define SWAP32(x) ({ uint32_t y=(x); (((y)>>24 & 0xfful) | ((y)>>8 & 0xff00ul) | ((y)<<8 & 0xff0000ul) | ((y)<<24 & 0xff000000ul)); })
|
|
|
|
#ifdef __BIG_ENDIAN__
|
|
|
|
// big endian config
|
|
#define HOST2LE32(x) SWAP32(x)
|
|
#define HOST2BE32(x) (x)
|
|
#define LE2HOST32(x) SWAP32(x)
|
|
#define BE2HOST32(x) (x)
|
|
|
|
#define HOST2LE16(x) SWAP16(x)
|
|
#define HOST2BE16(x) (x)
|
|
#define LE2HOST16(x) SWAP16(x)
|
|
#define BE2HOST16(x) (x)
|
|
|
|
#else
|
|
|
|
// little endian config
|
|
#define HOST2LE32(x) (x)
|
|
#define HOST2BE32(x) SWAP32(x)
|
|
#define LE2HOST32(x) (x)
|
|
#define BE2HOST32(x) SWAP32(x)
|
|
|
|
#define HOST2LE16(x) (x)
|
|
#define HOST2BE16(x) SWAP16(x)
|
|
#define LE2HOST16(x) (x)
|
|
#define BE2HOST16(x) SWAP16(x)
|
|
|
|
#endif
|
|
|
|
#define GETLEs16(X) ((int16_t)GETLE16((uint16_t *)X))
|
|
#define GETLEs32(X) ((int16_t)GETLE32((uint16_t *)X))
|
|
|
|
#if defined(__PPC__) && defined(__BIG_ENDIAN__)
|
|
|
|
// GCC style
|
|
static __inline__ uint16_t GETLE16(uint16_t *ptr) {
|
|
uint16_t ret; __asm__ ("lhbrx %0, 0, %1" : "=r" (ret) : "r" (ptr));
|
|
return ret;
|
|
}
|
|
static __inline__ uint32_t GETLE32(uint32_t *ptr) {
|
|
uint32_t ret;
|
|
__asm__ ("lwbrx %0, 0, %1" : "=r" (ret) : "r" (ptr));
|
|
return ret;
|
|
}
|
|
static __inline__ uint32_t GETLE16D(uint32_t *ptr) {
|
|
uint32_t ret;
|
|
__asm__ ("lwbrx %0, 0, %1\n"
|
|
"rlwinm %0, %0, 16, 0, 31" : "=r" (ret) : "r" (ptr));
|
|
return ret;
|
|
}
|
|
|
|
static __inline__ void PUTLE16(uint16_t *ptr, uint16_t val) {
|
|
__asm__ ("sthbrx %0, 0, %1" : : "r" (val), "r" (ptr) : "memory");
|
|
}
|
|
static __inline__ void PUTLE32(uint32_t *ptr, uint32_t val) {
|
|
__asm__ ("stwbrx %0, 0, %1" : : "r" (val), "r" (ptr) : "memory");
|
|
}
|
|
|
|
#else
|
|
#define GETLE16(X) LE2HOST16(*(uint16_t *)X)
|
|
#define GETLE32(X) LE2HOST32(*(uint32_t *)X)
|
|
#define GETLE16D(X) ({uint32_t val = GETLE32(X); (val<<16 | val >> 16);})
|
|
#define PUTLE16(X, Y) do{*((uint16_t *)X)=HOST2LE16((uint16_t)Y);}while(0)
|
|
#define PUTLE32(X, Y) do{*((uint32_t *)X)=HOST2LE16((uint32_t)Y);}while(0)
|
|
#endif
|