You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
175 lines
6.8 KiB
175 lines
6.8 KiB
2 months ago
|
/*
|
||
|
|
* UCW Library -- Fast Access to Unaligned Data
|
||
|
|
*
|
||
|
|
* (c) 1997--2007 Martin Mares <mj@ucw.cz>
|
||
|
|
*
|
||
|
|
* This software may be freely distributed and used according to the terms
|
||
|
|
* of the GNU Lesser General Public License.
|
||
|
|
*/
|
||
|
|
|
||
|
|
#ifndef _UCW_UNALIGNED_H
|
||
|
|
#define _UCW_UNALIGNED_H
|
||
|
|
|
||
|
|
/* Big endian format */
|
||
|
|
|
||
|
|
#if defined(CPU_ALLOW_UNALIGNED) && defined(CPU_BIG_ENDIAN)
|
||
|
|
static inline uint get_u16_be(const void *p) { return *(u16 *)p; } /** Read 16-bit integer value from an unaligned sequence of 2 bytes (big-endian version). **/
|
||
|
|
static inline u32 get_u32_be(const void *p) { return *(u32 *)p; } /** Read 32-bit integer value from an unaligned sequence of 4 bytes (big-endian version). **/
|
||
|
|
static inline u64 get_u64_be(const void *p) { return *(u64 *)p; } /** Read 64-bit integer value from an unaligned sequence of 8 bytes (big-endian version). **/
|
||
|
|
static inline void put_u16_be(void *p, uint x) { *(u16 *)p = x; } /** Write 16-bit integer value to an unaligned sequence of 2 bytes (big-endian version). **/
|
||
|
|
static inline void put_u32_be(void *p, u32 x) { *(u32 *)p = x; } /** Write 32-bit integer value to an unaligned sequence of 4 bytes (big-endian version). **/
|
||
|
|
static inline void put_u64_be(void *p, u64 x) { *(u64 *)p = x; } /** Write 64-bit integer value to an unaligned sequence of 8 bytes (big-endian version). **/
|
||
|
|
#else
|
||
|
|
static inline uint get_u16_be(const void *p)
|
||
|
|
{
|
||
|
|
const byte *c = (const byte *)p;
|
||
|
|
return (c[0] << 8) | c[1];
|
||
|
|
}
|
||
|
|
static inline u32 get_u32_be(const void *p)
|
||
|
|
{
|
||
|
|
const byte *c = (const byte *)p;
|
||
|
|
return (c[0] << 24) | (c[1] << 16) | (c[2] << 8) | c[3];
|
||
|
|
}
|
||
|
|
static inline u64 get_u64_be(const void *p)
|
||
|
|
{
|
||
|
|
return ((u64) get_u32_be(p) << 32) | get_u32_be((const byte *)p+4);
|
||
|
|
}
|
||
|
|
static inline void put_u16_be(void *p, uint x)
|
||
|
|
{
|
||
|
|
byte *c = (byte *)p;
|
||
|
|
c[0] = x >> 8;
|
||
|
|
c[1] = x;
|
||
|
|
}
|
||
|
|
static inline void put_u32_be(void *p, u32 x)
|
||
|
|
{
|
||
|
|
byte *c = (byte *)p;
|
||
|
|
c[0] = x >> 24;
|
||
|
|
c[1] = x >> 16;
|
||
|
|
c[2] = x >> 8;
|
||
|
|
c[3] = x;
|
||
|
|
}
|
||
|
|
static inline void put_u64_be(void *p, u64 x)
|
||
|
|
{
|
||
|
|
put_u32_be(p, x >> 32);
|
||
|
|
put_u32_be((byte *)p+4, x);
|
||
|
|
}
|
||
|
|
#endif
|
||
|
|
|
||
|
|
static inline u64 get_u40_be(const void *p) /** Read 40-bit integer value from an unaligned sequence of 5 bytes (big-endian version). **/
|
||
|
|
{
|
||
|
|
const byte *c = (const byte *)p;
|
||
|
|
return ((u64)c[0] << 32) | get_u32_be(c+1);
|
||
|
|
}
|
||
|
|
|
||
|
|
static inline void put_u40_be(void *p, u64 x)
|
||
|
|
{
|
||
|
|
byte *c = (byte *)p;
|
||
|
|
c[0] = x >> 32;
|
||
|
|
put_u32_be(c+1, x);
|
||
|
|
}
|
||
|
|
|
||
|
|
/* Little-endian format */
|
||
|
|
|
||
|
|
#if defined(CPU_ALLOW_UNALIGNED) && !defined(CPU_BIG_ENDIAN)
|
||
|
|
static inline uint get_u16_le(const void *p) { return *(u16 *)p; } /** Read 16-bit integer value from an unaligned sequence of 2 bytes (little-endian version). **/
|
||
|
|
static inline u32 get_u32_le(const void *p) { return *(u32 *)p; } /** Read 32-bit integer value from an unaligned sequence of 4 bytes (little-endian version). **/
|
||
|
|
static inline u64 get_u64_le(const void *p) { return *(u64 *)p; } /** Read 64-bit integer value from an unaligned sequence of 8 bytes (little-endian version). **/
|
||
|
|
static inline void put_u16_le(void *p, uint x) { *(u16 *)p = x; } /** Write 16-bit integer value to an unaligned sequence of 2 bytes (little-endian version). **/
|
||
|
|
static inline void put_u32_le(void *p, u32 x) { *(u32 *)p = x; } /** Write 32-bit integer value to an unaligned sequence of 4 bytes (little-endian version). **/
|
||
|
|
static inline void put_u64_le(void *p, u64 x) { *(u64 *)p = x; } /** Write 64-bit integer value to an unaligned sequence of 8 bytes (little-endian version). **/
|
||
|
|
#else
|
||
|
|
static inline uint get_u16_le(const void *p)
|
||
|
|
{
|
||
|
|
const byte *c = p;
|
||
|
|
return c[0] | (c[1] << 8);
|
||
|
|
}
|
||
|
|
static inline u32 get_u32_le(const void *p)
|
||
|
|
{
|
||
|
|
const byte *c = p;
|
||
|
|
return c[0] | (c[1] << 8) | (c[2] << 16) | (c[3] << 24);
|
||
|
|
}
|
||
|
|
static inline u64 get_u64_le(const void *p)
|
||
|
|
{
|
||
|
|
return get_u32_le(p) | ((u64) get_u32_le((const byte *)p+4) << 32);
|
||
|
|
}
|
||
|
|
static inline void put_u16_le(void *p, uint x)
|
||
|
|
{
|
||
|
|
byte *c = p;
|
||
|
|
c[0] = x;
|
||
|
|
c[1] = x >> 8;
|
||
|
|
}
|
||
|
|
static inline void put_u32_le(void *p, u32 x)
|
||
|
|
{
|
||
|
|
byte *c = p;
|
||
|
|
c[0] = x;
|
||
|
|
c[1] = x >> 8;
|
||
|
|
c[2] = x >> 16;
|
||
|
|
c[3] = x >> 24;
|
||
|
|
}
|
||
|
|
static inline void put_u64_le(void *p, u64 x)
|
||
|
|
{
|
||
|
|
put_u32_le(p, x);
|
||
|
|
put_u32_le((byte *)p+4, x >> 32);
|
||
|
|
}
|
||
|
|
#endif
|
||
|
|
|
||
|
|
static inline u64 get_u40_le(const void *p) /** Read 40-bit integer value from an unaligned sequence of 5 bytes (little-endian version). **/
|
||
|
|
{
|
||
|
|
const byte *c = (const byte *)p;
|
||
|
|
return get_u32_le(c) | ((u64) c[4] << 32);
|
||
|
|
}
|
||
|
|
|
||
|
|
static inline void put_u40_le(void *p, u64 x)
|
||
|
|
{
|
||
|
|
byte *c = (byte *)p;
|
||
|
|
put_u32_le(c, x);
|
||
|
|
c[4] = x >> 32;
|
||
|
|
}
|
||
|
|
|
||
|
|
/* The native format */
|
||
|
|
|
||
|
|
#ifdef CPU_BIG_ENDIAN
|
||
|
|
|
||
|
|
static inline uint get_u16(const void *p) { return get_u16_be(p); } /** Read 16-bit integer value from an unaligned sequence of 2 bytes (native byte-order). **/
|
||
|
|
static inline u32 get_u32(const void *p) { return get_u32_be(p); } /** Read 32-bit integer value from an unaligned sequence of 4 bytes (native byte-order). **/
|
||
|
|
static inline u64 get_u64(const void *p) { return get_u64_be(p); } /** Read 64-bit integer value from an unaligned sequence of 8 bytes (native byte-order). **/
|
||
|
|
static inline u64 get_u40(const void *p) { return get_u40_be(p); } /** Read 40-bit integer value from an unaligned sequence of 5 bytes (native byte-order). **/
|
||
|
|
static inline void put_u16(void *p, uint x) { return put_u16_be(p, x); } /** Write 16-bit integer value to an unaligned sequence of 2 bytes (native byte-order). **/
|
||
|
|
static inline void put_u32(void *p, u32 x) { return put_u32_be(p, x); } /** Write 32-bit integer value to an unaligned sequence of 4 bytes (native byte-order). **/
|
||
|
|
static inline void put_u64(void *p, u64 x) { return put_u64_be(p, x); } /** Write 64-bit integer value to an unaligned sequence of 8 bytes (native byte-order). **/
|
||
|
|
static inline void put_u40(void *p, u64 x) { return put_u40_be(p, x); } /** Write 40-bit integer value to an unaligned sequence of 5 bytes (native byte-order). **/
|
||
|
|
|
||
|
|
#else
|
||
|
|
|
||
|
|
static inline uint get_u16(const void *p) { return get_u16_le(p); }
|
||
|
|
static inline u32 get_u32(const void *p) { return get_u32_le(p); }
|
||
|
|
static inline u64 get_u64(const void *p) { return get_u64_le(p); }
|
||
|
|
static inline u64 get_u40(const void *p) { return get_u40_le(p); }
|
||
|
|
static inline void put_u16(void *p, uint x) { return put_u16_le(p, x); }
|
||
|
|
static inline void put_u32(void *p, u32 x) { return put_u32_le(p, x); }
|
||
|
|
static inline void put_u64(void *p, u64 x) { return put_u64_le(p, x); }
|
||
|
|
static inline void put_u40(void *p, u64 x) { return put_u40_le(p, x); }
|
||
|
|
|
||
|
|
#endif
|
||
|
|
|
||
|
|
/* Just for completeness */
|
||
|
|
|
||
|
|
static inline uint get_u8(const void *p) { return *(const byte *)p; } /** Read 8-bit integer value. **/
|
||
|
|
static inline void put_u8(void *p, uint x) { *(byte *)p = x; } /** Write 8-bit integer value. **/
|
||
|
|
|
||
|
|
/* Backward compatibility macros */
|
||
|
|
|
||
|
|
#define GET_U8(p) get_u8(p)
|
||
|
|
#define GET_U16(p) get_u16(p)
|
||
|
|
#define GET_U32(p) get_u32(p)
|
||
|
|
#define GET_U64(p) get_u64(p)
|
||
|
|
#define GET_U40(p) get_u40(p)
|
||
|
|
|
||
|
|
#define PUT_U8(p,x) put_u8(p,x);
|
||
|
|
#define PUT_U16(p,x) put_u16(p,x)
|
||
|
|
#define PUT_U32(p,x) put_u32(p,x)
|
||
|
|
#define PUT_U64(p,x) put_u64(p,x)
|
||
|
|
#define PUT_U40(p,x) put_u40(p,x)
|
||
|
|
|
||
|
|
#endif
|