X-Git-Url: https://git.gag.com/?a=blobdiff_plain;ds=inline;f=src%2Fhelper%2Ftypes.h;h=b99ece109815ad70faf7a3852f39d70ccac65964;hb=bb8d37ddf12a2ad76ede129b63522bfa2940d34e;hp=04b005945939fb8925633b5762b25bc2f1442ae0;hpb=f6a3fc818bc6a24b6c5bbcc6057f72d2b0b2e2ab;p=fw%2Fopenocd diff --git a/src/helper/types.h b/src/helper/types.h index 04b005945..b99ece109 100644 --- a/src/helper/types.h +++ b/src/helper/types.h @@ -1,29 +1,22 @@ +/* SPDX-License-Identifier: GPL-2.0-or-later */ + /*************************************************************************** * Copyright (C) 2004, 2005 by Dominic Rath * * Dominic.Rath@gmx.de * * * * Copyright (C) 2007,2008 Øyvind Harboe * * oyvind.harboe@zylin.com * - * * - * This program is free software; you can redistribute it and/or modify * - * it under the terms of the GNU General Public License as published by * - * the Free Software Foundation; either version 2 of the License, or * - * (at your option) any later version. * - * * - * This program is distributed in the hope that it will be useful, * - * but WITHOUT ANY WARRANTY; without even the implied warranty of * - * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * - * GNU General Public License for more details. * - * * - * You should have received a copy of the GNU General Public License * - * along with this program; if not, write to the * - * Free Software Foundation, Inc., * - * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. * ***************************************************************************/ -#ifndef TYPES_H -#define TYPES_H + +#ifndef OPENOCD_HELPER_TYPES_H +#define OPENOCD_HELPER_TYPES_H + +#ifdef HAVE_CONFIG_H +#include "config.h" +#endif #include +#include #ifdef HAVE_SYS_TYPES_H #include #endif @@ -43,16 +36,10 @@ #ifndef __cplusplus #define false 0 -#define true 1 +#define true 1 -typedef int _Bool; -#else -typedef bool _Bool; #endif /* __cplusplus */ #endif /* HAVE__BOOL */ - -#define bool _Bool - #endif /* HAVE_STDBOOL_H */ /// turns a macro argument into a string constant @@ -110,36 +97,93 @@ typedef bool _Bool; * Again, note that the "buf" pointer in memory is probably unaligned. */ +static inline uint64_t le_to_h_u64(const uint8_t *buf) +{ + return (uint64_t)((uint64_t)buf[0] | + (uint64_t)buf[1] << 8 | + (uint64_t)buf[2] << 16 | + (uint64_t)buf[3] << 24 | + (uint64_t)buf[4] << 32 | + (uint64_t)buf[5] << 40 | + (uint64_t)buf[6] << 48 | + (uint64_t)buf[7] << 56); +} + +static inline uint32_t le_to_h_u32(const uint8_t *buf) +{ + return (uint32_t)((uint32_t)buf[0] | (uint32_t)buf[1] << 8 | (uint32_t)buf[2] << 16 | (uint32_t)buf[3] << 24); +} + +static inline uint32_t le_to_h_u24(const uint8_t *buf) +{ + return (uint32_t)((uint32_t)buf[0] | (uint32_t)buf[1] << 8 | (uint32_t)buf[2] << 16); +} -static inline uint32_t le_to_h_u32(const uint8_t* buf) +static inline uint16_t le_to_h_u16(const uint8_t *buf) { - return (uint32_t)(buf[0] | buf[1] << 8 | buf[2] << 16 | buf[3] << 24); + return (uint16_t)((uint16_t)buf[0] | (uint16_t)buf[1] << 8); } -static inline uint16_t le_to_h_u16(const uint8_t* buf) +static inline uint64_t be_to_h_u64(const uint8_t *buf) { - return (uint16_t)(buf[0] | buf[1] << 8); + return (uint64_t)((uint64_t)buf[7] | + (uint64_t)buf[6] << 8 | + (uint64_t)buf[5] << 16 | + (uint64_t)buf[4] << 24 | + (uint64_t)buf[3] << 32 | + (uint64_t)buf[2] << 40 | + (uint64_t)buf[1] << 48 | + (uint64_t)buf[0] << 56); } -static inline uint32_t be_to_h_u32(const uint8_t* buf) +static inline uint32_t be_to_h_u32(const uint8_t *buf) { - return (uint32_t)(buf[3] | buf[2] << 8 | buf[1] << 16 | buf[0] << 24); + return (uint32_t)((uint32_t)buf[3] | (uint32_t)buf[2] << 8 | (uint32_t)buf[1] << 16 | (uint32_t)buf[0] << 24); } -static inline uint16_t be_to_h_u16(const uint8_t* buf) +static inline uint32_t be_to_h_u24(const uint8_t *buf) { - return (uint16_t)(buf[1] | buf[0] << 8); + return (uint32_t)((uint32_t)buf[2] | (uint32_t)buf[1] << 8 | (uint32_t)buf[0] << 16); } -static inline void h_u32_to_le(uint8_t* buf, int val) +static inline uint16_t be_to_h_u16(const uint8_t *buf) { + return (uint16_t)((uint16_t)buf[1] | (uint16_t)buf[0] << 8); +} + +static inline void h_u64_to_le(uint8_t *buf, int64_t val) +{ + buf[7] = (uint8_t) (val >> 56); + buf[6] = (uint8_t) (val >> 48); + buf[5] = (uint8_t) (val >> 40); + buf[4] = (uint8_t) (val >> 32); buf[3] = (uint8_t) (val >> 24); buf[2] = (uint8_t) (val >> 16); buf[1] = (uint8_t) (val >> 8); buf[0] = (uint8_t) (val >> 0); } -static inline void h_u32_to_be(uint8_t* buf, int val) +static inline void h_u64_to_be(uint8_t *buf, int64_t val) +{ + buf[0] = (uint8_t) (val >> 56); + buf[1] = (uint8_t) (val >> 48); + buf[2] = (uint8_t) (val >> 40); + buf[3] = (uint8_t) (val >> 32); + buf[4] = (uint8_t) (val >> 24); + buf[5] = (uint8_t) (val >> 16); + buf[6] = (uint8_t) (val >> 8); + buf[7] = (uint8_t) (val >> 0); +} + +static inline void h_u32_to_le(uint8_t *buf, int val) +{ + buf[3] = (uint8_t) (val >> 24); + buf[2] = (uint8_t) (val >> 16); + buf[1] = (uint8_t) (val >> 8); + buf[0] = (uint8_t) (val >> 0); +} + +static inline void h_u32_to_be(uint8_t *buf, int val) { buf[0] = (uint8_t) (val >> 24); buf[1] = (uint8_t) (val >> 16); @@ -147,18 +191,91 @@ static inline void h_u32_to_be(uint8_t* buf, int val) buf[3] = (uint8_t) (val >> 0); } -static inline void h_u16_to_le(uint8_t* buf, int val) +static inline void h_u24_to_le(uint8_t *buf, int val) { + buf[2] = (uint8_t) (val >> 16); buf[1] = (uint8_t) (val >> 8); buf[0] = (uint8_t) (val >> 0); } -static inline void h_u16_to_be(uint8_t* buf, int val) +static inline void h_u24_to_be(uint8_t *buf, int val) +{ + buf[0] = (uint8_t) (val >> 16); + buf[1] = (uint8_t) (val >> 8); + buf[2] = (uint8_t) (val >> 0); +} + +static inline void h_u16_to_le(uint8_t *buf, int val) +{ + buf[1] = (uint8_t) (val >> 8); + buf[0] = (uint8_t) (val >> 0); +} + +static inline void h_u16_to_be(uint8_t *buf, int val) { buf[0] = (uint8_t) (val >> 8); buf[1] = (uint8_t) (val >> 0); } +/** + * Byte-swap buffer 16-bit. + * + * Len must be even, dst and src must be either the same or non-overlapping. + * + * @param dst Destination buffer. + * @param src Source buffer. + * @param len Length of source (and destination) buffer, in bytes. + */ +static inline void buf_bswap16(uint8_t *dst, const uint8_t *src, size_t len) +{ + assert(len % 2 == 0); + assert(dst == src || dst + len <= src || src + len <= dst); + + for (size_t n = 0; n < len; n += 2) { + uint16_t x = be_to_h_u16(src + n); + h_u16_to_le(dst + n, x); + } +} + +/** + * Byte-swap buffer 32-bit. + * + * Len must be divisible by four, dst and src must be either the same or non-overlapping. + * + * @param dst Destination buffer. + * @param src Source buffer. + * @param len Length of source (and destination) buffer, in bytes. + */ +static inline void buf_bswap32(uint8_t *dst, const uint8_t *src, size_t len) +{ + assert(len % 4 == 0); + assert(dst == src || dst + len <= src || src + len <= dst); + + for (size_t n = 0; n < len; n += 4) { + uint32_t x = be_to_h_u32(src + n); + h_u32_to_le(dst + n, x); + } +} + +/** + * Calculate the (even) parity of a 32-bit datum. + * @param x The datum. + * @return 1 if the number of set bits in x is odd, 0 if it is even. + */ +static inline int parity_u32(uint32_t x) +{ +#ifdef __GNUC__ + return __builtin_parityl(x); +#else + x ^= x >> 16; + x ^= x >> 8; + x ^= x >> 4; + x ^= x >> 2; + x ^= x >> 1; + return x & 1; +#endif +} + #if defined(__ECOS) /* eCos plain lacks these definition... A series of upstream patches @@ -167,12 +284,21 @@ static inline void h_u16_to_be(uint8_t* buf, int val) */ #if !defined(_STDINT_H) -#define PRIx32 "x" #define PRId32 "d" -#define SCNx32 "x" #define PRIi32 "i" +#define PRIo32 "o" #define PRIu32 "u" +#define PRIx32 "x" +#define PRIX32 "X" +#define SCNx32 "x" #define PRId8 PRId32 +#define SCNx64 "llx" +#define PRId64 "lld" +#define PRIi64 "lli" +#define PRIo64 "llo" +#define PRIu64 "llu" +#define PRIx64 "llx" +#define PRIX64 "llX" typedef CYG_ADDRWORD intptr_t; typedef int64_t intmax_t; @@ -191,11 +317,11 @@ typedef uint64_t uintmax_t; #define UINT64_MAX (__CONCAT(INT64_MAX, U) * 2ULL + 1ULL) #endif - #ifndef LLONG_MAX + #ifndef LLONG_MAX #define ULLONG_MAX UINT64_C(0xFFFFFFFFFFFFFFFF) #define LLONG_MAX INT64_C(0x7FFFFFFFFFFFFFFF) #define LLONG_MIN ULLONG_MAX - #endif + #endif #define ULLONG_MAX 18446744073709551615 @@ -206,4 +332,13 @@ typedef uint64_t uintmax_t; #endif -#endif /* TYPES_H */ +typedef uint64_t target_addr_t; +#define TARGET_ADDR_MAX UINT64_MAX +#define TARGET_PRIdADDR PRId64 +#define TARGET_PRIuADDR PRIu64 +#define TARGET_PRIoADDR PRIo64 +#define TARGET_PRIxADDR PRIx64 +#define TARGET_PRIXADDR PRIX64 +#define TARGET_ADDR_FMT "0x%8.8" TARGET_PRIxADDR + +#endif /* OPENOCD_HELPER_TYPES_H */