c444d166f3
RISC-V doesn't support unaligned access, so check for that before decoding and encoding. It is not perfectly performant, but still much better then invoking the misaligned exception handler every time there is a misaligned access. We can't modify our whole codebase to always do aligned access, because it is neither feasible in long term nor is fair to add that performance penalty onto other architectures that do support unaligned access. So this is the next best thing. On architectures that do support unaligned access the compiler will just optimize the RISCV_ENV part out and should result in the exact same binary. tested: identical binary on QEMU-aarch64 and QEMU-q35. Change-Id: I4dfccfdc2b302dd30b7ce5a29520c86add13169d Signed-off-by: Maximilian Brune <maximilian.brune@9elements.com> Reviewed-on: https://review.coreboot.org/c/coreboot/+/86609 Tested-by: build bot (Jenkins) <no-reply@coreboot.org> Reviewed-by: Julius Werner <jwerner@chromium.org>
180 lines
5.3 KiB
C
180 lines
5.3 KiB
C
/* SPDX-License-Identifier: GPL-2.0-or-later */
|
|
|
|
#ifndef _ENDIAN_H_
|
|
#define _ENDIAN_H_
|
|
|
|
#include <arch/byteorder.h>
|
|
#include <stdint.h>
|
|
#include <string.h>
|
|
#include <swab.h>
|
|
|
|
#if defined(__LITTLE_ENDIAN)
|
|
#define cpu_to_le64(x) ((uint64_t)(x))
|
|
#define le64_to_cpu(x) ((uint64_t)(x))
|
|
#define cpu_to_le32(x) ((uint32_t)(x))
|
|
#define le32_to_cpu(x) ((uint32_t)(x))
|
|
#define cpu_to_le16(x) ((uint16_t)(x))
|
|
#define le16_to_cpu(x) ((uint16_t)(x))
|
|
#define cpu_to_be64(x) swab64(x)
|
|
#define be64_to_cpu(x) swab64(x)
|
|
#define cpu_to_be32(x) swab32(x)
|
|
#define be32_to_cpu(x) swab32(x)
|
|
#define cpu_to_be16(x) swab16(x)
|
|
#define be16_to_cpu(x) swab16(x)
|
|
#elif defined(__BIG_ENDIAN)
|
|
#define cpu_to_le64(x) swab64(x)
|
|
#define le64_to_cpu(x) swab64(x)
|
|
#define cpu_to_le32(x) swab32(x)
|
|
#define le32_to_cpu(x) swab32(x)
|
|
#define cpu_to_le16(x) swab16(x)
|
|
#define le16_to_cpu(x) swab16(x)
|
|
#define cpu_to_be64(x) ((uint64_t)(x))
|
|
#define be64_to_cpu(x) ((uint64_t)(x))
|
|
#define cpu_to_be32(x) ((uint32_t)(x))
|
|
#define be32_to_cpu(x) ((uint32_t)(x))
|
|
#define cpu_to_be16(x) ((uint16_t)(x))
|
|
#define be16_to_cpu(x) ((uint16_t)(x))
|
|
#else
|
|
#error "<arch/byteorder.h> must #define __LITTLE_ENDIAN or __BIG_ENDIAN"
|
|
#endif
|
|
|
|
#define ntohll(x) be64_to_cpu(x)
|
|
#define htonll(x) cpu_to_be64(x)
|
|
#define ntohl(x) be32_to_cpu(x)
|
|
#define htonl(x) cpu_to_be32(x)
|
|
|
|
#define __clrsetbits(endian, bits, addr, clear, set) \
|
|
write##bits(addr, cpu_to_##endian##bits((endian##bits##_to_cpu( \
|
|
read##bits(addr)) & ~((uint##bits##_t)(clear))) | (set)))
|
|
|
|
#define clrbits_le64(addr, clear) __clrsetbits(le, 64, addr, clear, 0)
|
|
#define clrbits_be64(addr, clear) __clrsetbits(be, 64, addr, clear, 0)
|
|
#define clrbits_le32(addr, clear) __clrsetbits(le, 32, addr, clear, 0)
|
|
#define clrbits_be32(addr, clear) __clrsetbits(be, 32, addr, clear, 0)
|
|
#define clrbits_le16(addr, clear) __clrsetbits(le, 16, addr, clear, 0)
|
|
#define clrbits_be16(addr, clear) __clrsetbits(be, 16, addr, clear, 0)
|
|
|
|
#define setbits_le64(addr, set) __clrsetbits(le, 64, addr, 0, set)
|
|
#define setbits_be64(addr, set) __clrsetbits(be, 64, addr, 0, set)
|
|
#define setbits_le32(addr, set) __clrsetbits(le, 32, addr, 0, set)
|
|
#define setbits_be32(addr, set) __clrsetbits(be, 32, addr, 0, set)
|
|
#define setbits_le16(addr, set) __clrsetbits(le, 16, addr, 0, set)
|
|
#define setbits_be16(addr, set) __clrsetbits(be, 16, addr, 0, set)
|
|
|
|
#define clrsetbits_le64(addr, clear, set) __clrsetbits(le, 64, addr, clear, set)
|
|
#define clrsetbits_be64(addr, clear, set) __clrsetbits(be, 64, addr, clear, set)
|
|
#define clrsetbits_le32(addr, clear, set) __clrsetbits(le, 32, addr, clear, set)
|
|
#define clrsetbits_be32(addr, clear, set) __clrsetbits(be, 32, addr, clear, set)
|
|
#define clrsetbits_le16(addr, clear, set) __clrsetbits(le, 16, addr, clear, set)
|
|
#define clrsetbits_be16(addr, clear, set) __clrsetbits(be, 16, addr, clear, set)
|
|
|
|
/*
|
|
* be16dec/be32dec/be64dec/le16dec/le32dec/le64dec family of functions.
|
|
* RISC-V doesn't support misaligned access so decode it byte by byte.
|
|
*/
|
|
#define DEFINE_ENDIAN_DEC(endian, width) \
|
|
static inline uint##width##_t endian##width##dec(const void *p) \
|
|
{ \
|
|
if (ENV_RISCV) { \
|
|
uint##width##_t val; \
|
|
memcpy(&val, p, sizeof(val)); \
|
|
return endian##width##_to_cpu(val); \
|
|
} else { \
|
|
return endian##width##_to_cpu(*(uint##width##_t *)p); \
|
|
} \
|
|
}
|
|
|
|
DEFINE_ENDIAN_DEC(be, 16)
|
|
DEFINE_ENDIAN_DEC(be, 32)
|
|
DEFINE_ENDIAN_DEC(be, 64)
|
|
DEFINE_ENDIAN_DEC(le, 16)
|
|
DEFINE_ENDIAN_DEC(le, 32)
|
|
DEFINE_ENDIAN_DEC(le, 64)
|
|
|
|
/*
|
|
* be16enc/be32enc/be64enc/le16enc/le32enc/le64enc family of functions.
|
|
* RISC-V doesn't support misaligned access so encode it byte by byte.
|
|
*/
|
|
#define DEFINE_ENDIAN_ENC(endian, width) \
|
|
static inline void endian##width##enc(void *p, uint##width##_t u) \
|
|
{ \
|
|
if (ENV_RISCV) { \
|
|
uint##width##_t val = cpu_to_##endian##width(u); \
|
|
memcpy(p, &val, sizeof(val)); \
|
|
} else { \
|
|
*(uint##width##_t *)p = cpu_to_##endian##width(u); \
|
|
} \
|
|
}
|
|
|
|
DEFINE_ENDIAN_ENC(be, 16)
|
|
DEFINE_ENDIAN_ENC(be, 32)
|
|
DEFINE_ENDIAN_ENC(be, 64)
|
|
DEFINE_ENDIAN_ENC(le, 16)
|
|
DEFINE_ENDIAN_ENC(le, 32)
|
|
DEFINE_ENDIAN_ENC(le, 64)
|
|
|
|
/*
|
|
* Portable (API) endian support that can be used in code that is shared
|
|
* with userspace (man 3 endian) tools.
|
|
*/
|
|
static inline uint16_t htobe16(uint16_t host_16bits)
|
|
{
|
|
return cpu_to_be16(host_16bits);
|
|
}
|
|
|
|
static inline uint16_t htole16(uint16_t host_16bits)
|
|
{
|
|
return cpu_to_le16(host_16bits);
|
|
}
|
|
|
|
static inline uint16_t be16toh(uint16_t big_endian_16bits)
|
|
{
|
|
return be16_to_cpu(big_endian_16bits);
|
|
}
|
|
|
|
static inline uint16_t le16toh(uint16_t little_endian_16bits)
|
|
{
|
|
return le16_to_cpu(little_endian_16bits);
|
|
}
|
|
|
|
static inline uint32_t htobe32(uint32_t host_32bits)
|
|
{
|
|
return cpu_to_be32(host_32bits);
|
|
}
|
|
|
|
static inline uint32_t htole32(uint32_t host_32bits)
|
|
{
|
|
return cpu_to_le32(host_32bits);
|
|
}
|
|
|
|
static inline uint32_t be32toh(uint32_t big_endian_32bits)
|
|
{
|
|
return be32_to_cpu(big_endian_32bits);
|
|
}
|
|
|
|
static inline uint32_t le32toh(uint32_t little_endian_32bits)
|
|
{
|
|
return le32_to_cpu(little_endian_32bits);
|
|
}
|
|
|
|
static inline uint64_t htobe64(uint64_t host_64bits)
|
|
{
|
|
return cpu_to_be64(host_64bits);
|
|
}
|
|
|
|
static inline uint64_t htole64(uint64_t host_64bits)
|
|
{
|
|
return cpu_to_le64(host_64bits);
|
|
}
|
|
|
|
static inline uint64_t be64toh(uint64_t big_endian_64bits)
|
|
{
|
|
return be64_to_cpu(big_endian_64bits);
|
|
}
|
|
|
|
static inline uint64_t le64toh(uint64_t little_endian_64bits)
|
|
{
|
|
return le64_to_cpu(little_endian_64bits);
|
|
}
|
|
|
|
#endif
|