X-Git-Url: https://sigrok.org/gitweb/?p=libsigrok.git;a=blobdiff_plain;f=src%2Flibsigrok-internal.h;h=75c91e92b7e6da482ac885540daf53e978605df7;hp=0dfacbce1f09188fde9b0e0dca99893a277b7ff1;hb=400bc4ffabc40c438fb5eb2210cf289aebac2a9e;hpb=bf5c4d46f8453f810b6f7615d2c16c9f752f9246 diff --git a/src/libsigrok-internal.h b/src/libsigrok-internal.h index 0dfacbce..75c91e92 100644 --- a/src/libsigrok-internal.h +++ b/src/libsigrok-internal.h @@ -17,12 +17,6 @@ * along with this program. If not, see . */ -/** - * @file - * - * @internal - */ - #ifndef LIBSIGROK_LIBSIGROK_INTERNAL_H #define LIBSIGROK_LIBSIGROK_INTERNAL_H @@ -62,202 +56,876 @@ struct zip_stat; #define ARRAY_AND_SIZE(a) (a), ARRAY_SIZE(a) #endif +#ifndef G_SOURCE_FUNC +#define G_SOURCE_FUNC(f) ((GSourceFunc) (void (*)(void)) (f)) /* Since 2.58. */ +#endif + +#define SR_RECEIVE_DATA_CALLBACK(f) \ + ((sr_receive_data_callback) (void (*)(void)) (f)) + /** * Read a 8 bits unsigned integer out of memory. * @param x a pointer to the input memory * @return the corresponding unsigned integer */ -#define R8(x) ((unsigned)((const uint8_t*)(x))[0]) +static inline uint8_t read_u8(const uint8_t *p) +{ + return p[0]; +} +#define R8(x) read_u8((const uint8_t *)(x)) + +/** + * Read an 8 bits signed integer out of memory. + * @param x a pointer to the input memory + * @return the corresponding signed integer + */ +static inline int8_t read_i8(const uint8_t *p) +{ + return (int8_t)p[0]; +} /** * Read a 16 bits big endian unsigned integer out of memory. * @param x a pointer to the input memory * @return the corresponding unsigned integer */ -#define RB16(x) (((unsigned)((const uint8_t*)(x))[0] << 8) | \ - (unsigned)((const uint8_t*)(x))[1]) +static inline uint16_t read_u16be(const uint8_t *p) +{ + uint16_t u; + + u = 0; + u <<= 8; u |= p[0]; + u <<= 8; u |= p[1]; + + return u; +} +#define RB16(x) read_u16be((const uint8_t *)(x)) /** * Read a 16 bits little endian unsigned integer out of memory. * @param x a pointer to the input memory * @return the corresponding unsigned integer */ -#define RL16(x) (((unsigned)((const uint8_t*)(x))[1] << 8) | \ - (unsigned)((const uint8_t*)(x))[0]) +static inline uint16_t read_u16le(const uint8_t *p) +{ + uint16_t u; + + u = 0; + u <<= 8; u |= p[1]; + u <<= 8; u |= p[0]; + + return u; +} +#define RL16(x) read_u16le((const uint8_t *)(x)) /** * Read a 16 bits big endian signed integer out of memory. * @param x a pointer to the input memory * @return the corresponding signed integer */ -#define RB16S(x) ((int16_t) \ - (((unsigned)((const uint8_t*)(x))[0] << 8) | \ - (unsigned)((const uint8_t*)(x))[1])) +static inline int16_t read_i16be(const uint8_t *p) +{ + uint16_t u; + int16_t i; + + u = read_u16be(p); + i = (int16_t)u; + + return i; +} +#define RB16S(x) read_i16be((const uint8_t *)(x)) /** * Read a 16 bits little endian signed integer out of memory. * @param x a pointer to the input memory * @return the corresponding signed integer */ -#define RL16S(x) ((int16_t) \ - (((unsigned)((const uint8_t*)(x))[1] << 8) | \ - (unsigned)((const uint8_t*)(x))[0])) +static inline int16_t read_i16le(const uint8_t *p) +{ + uint16_t u; + int16_t i; + + u = read_u16le(p); + i = (int16_t)u; + + return i; +} +#define RL16S(x) read_i16le((const uint8_t *)(x)) + +/** + * Read a 24 bits little endian unsigned integer out of memory. + * @param x a pointer to the input memory + * @return the corresponding unsigned integer + */ +static inline uint32_t read_u24le(const uint8_t *p) +{ + uint32_t u; + + u = 0; + u <<= 8; u |= p[2]; + u <<= 8; u |= p[1]; + u <<= 8; u |= p[0]; + + return u; +} /** * Read a 32 bits big endian unsigned integer out of memory. * @param x a pointer to the input memory * @return the corresponding unsigned integer */ -#define RB32(x) (((unsigned)((const uint8_t*)(x))[0] << 24) | \ - ((unsigned)((const uint8_t*)(x))[1] << 16) | \ - ((unsigned)((const uint8_t*)(x))[2] << 8) | \ - (unsigned)((const uint8_t*)(x))[3]) +static inline uint32_t read_u32be(const uint8_t *p) +{ + uint32_t u; + + u = 0; + u <<= 8; u |= p[0]; + u <<= 8; u |= p[1]; + u <<= 8; u |= p[2]; + u <<= 8; u |= p[3]; + + return u; +} +#define RB32(x) read_u32be((const uint8_t *)(x)) /** * Read a 32 bits little endian unsigned integer out of memory. * @param x a pointer to the input memory * @return the corresponding unsigned integer */ -#define RL32(x) (((unsigned)((const uint8_t*)(x))[3] << 24) | \ - ((unsigned)((const uint8_t*)(x))[2] << 16) | \ - ((unsigned)((const uint8_t*)(x))[1] << 8) | \ - (unsigned)((const uint8_t*)(x))[0]) +static inline uint32_t read_u32le(const uint8_t *p) +{ + uint32_t u; + + u = 0; + u <<= 8; u |= p[3]; + u <<= 8; u |= p[2]; + u <<= 8; u |= p[1]; + u <<= 8; u |= p[0]; + + return u; +} +#define RL32(x) read_u32le((const uint8_t *)(x)) /** * Read a 32 bits big endian signed integer out of memory. * @param x a pointer to the input memory * @return the corresponding signed integer */ -#define RB32S(x) ((int32_t) \ - (((unsigned)((const uint8_t*)(x))[0] << 24) | \ - ((unsigned)((const uint8_t*)(x))[1] << 16) | \ - ((unsigned)((const uint8_t*)(x))[2] << 8) | \ - (unsigned)((const uint8_t*)(x))[3])) +static inline int32_t read_i32be(const uint8_t *p) +{ + uint32_t u; + int32_t i; + + u = read_u32be(p); + i = (int32_t)u; + + return i; +} +#define RB32S(x) read_i32be((const uint8_t *)(x)) /** * Read a 32 bits little endian signed integer out of memory. * @param x a pointer to the input memory * @return the corresponding signed integer */ -#define RL32S(x) ((int32_t) \ - (((unsigned)((const uint8_t*)(x))[3] << 24) | \ - ((unsigned)((const uint8_t*)(x))[2] << 16) | \ - ((unsigned)((const uint8_t*)(x))[1] << 8) | \ - (unsigned)((const uint8_t*)(x))[0])) +static inline int32_t read_i32le(const uint8_t *p) +{ + uint32_t u; + int32_t i; + + u = read_u32le(p); + i = (int32_t)u; + + return i; +} +#define RL32S(x) read_i32le((const uint8_t *)(x)) /** * Read a 64 bits big endian unsigned integer out of memory. * @param x a pointer to the input memory * @return the corresponding unsigned integer */ -#define RB64(x) (((uint64_t)((const uint8_t*)(x))[0] << 56) | \ - ((uint64_t)((const uint8_t*)(x))[1] << 48) | \ - ((uint64_t)((const uint8_t*)(x))[2] << 40) | \ - ((uint64_t)((const uint8_t*)(x))[3] << 32) | \ - ((uint64_t)((const uint8_t*)(x))[4] << 24) | \ - ((uint64_t)((const uint8_t*)(x))[5] << 16) | \ - ((uint64_t)((const uint8_t*)(x))[6] << 8) | \ - (uint64_t)((const uint8_t*)(x))[7]) +static inline uint64_t read_u64be(const uint8_t *p) +{ + uint64_t u; + + u = 0; + u <<= 8; u |= p[0]; + u <<= 8; u |= p[1]; + u <<= 8; u |= p[2]; + u <<= 8; u |= p[3]; + u <<= 8; u |= p[4]; + u <<= 8; u |= p[5]; + u <<= 8; u |= p[6]; + u <<= 8; u |= p[7]; + + return u; +} +#define RB64(x) read_u64be((const uint8_t *)(x)) /** * Read a 64 bits little endian unsigned integer out of memory. * @param x a pointer to the input memory * @return the corresponding unsigned integer */ -#define RL64(x) (((uint64_t)((const uint8_t*)(x))[7] << 56) | \ - ((uint64_t)((const uint8_t*)(x))[6] << 48) | \ - ((uint64_t)((const uint8_t*)(x))[5] << 40) | \ - ((uint64_t)((const uint8_t*)(x))[4] << 32) | \ - ((uint64_t)((const uint8_t*)(x))[3] << 24) | \ - ((uint64_t)((const uint8_t*)(x))[2] << 16) | \ - ((uint64_t)((const uint8_t*)(x))[1] << 8) | \ - (uint64_t)((const uint8_t*)(x))[0]) +static inline uint64_t read_u64le(const uint8_t *p) +{ + uint64_t u; + + u = 0; + u <<= 8; u |= p[7]; + u <<= 8; u |= p[6]; + u <<= 8; u |= p[5]; + u <<= 8; u |= p[4]; + u <<= 8; u |= p[3]; + u <<= 8; u |= p[2]; + u <<= 8; u |= p[1]; + u <<= 8; u |= p[0]; + + return u; +} +#define RL64(x) read_u64le((const uint8_t *)(x)) + +/** + * Read a 64 bits big endian signed integer out of memory. + * @param x a pointer to the input memory + * @return the corresponding unsigned integer + */ +static inline int64_t read_i64be(const uint8_t *p) +{ + uint64_t u; + int64_t i; + + u = read_u64be(p); + i = (int64_t)u; + + return i; +} +#define RB64S(x) read_i64be((const uint8_t *)(x)) /** * Read a 64 bits little endian signed integer out of memory. * @param x a pointer to the input memory * @return the corresponding unsigned integer */ -#define RL64S(x) ((int64_t) \ - (((uint64_t)((const uint8_t*)(x))[7] << 56) | \ - ((uint64_t)((const uint8_t*)(x))[6] << 48) | \ - ((uint64_t)((const uint8_t*)(x))[5] << 40) | \ - ((uint64_t)((const uint8_t*)(x))[4] << 32) | \ - ((uint64_t)((const uint8_t*)(x))[3] << 24) | \ - ((uint64_t)((const uint8_t*)(x))[2] << 16) | \ - ((uint64_t)((const uint8_t*)(x))[1] << 8) | \ - (uint64_t)((const uint8_t*)(x))[0])) +static inline int64_t read_i64le(const uint8_t *p) +{ + uint64_t u; + int64_t i; + + u = read_u64le(p); + i = (int64_t)u; + + return i; +} +#define RL64S(x) read_i64le((const uint8_t *)(x)) /** - * Read a 32 bits big endian float out of memory. + * Read a 32 bits big endian float out of memory (single precision). * @param x a pointer to the input memory * @return the corresponding float */ -#define RBFL(x) ((union { uint32_t u; float f; }) { .u = RB32(x) }.f) +static inline float read_fltbe(const uint8_t *p) +{ + /* + * Implementor's note: Strictly speaking the "union" trick + * is not portable. But this phrase was found to work on the + * project's supported platforms, and serve well until a more + * appropriate phrase is found. + */ + union { uint32_t u32; float flt; } u; + float f; + + u.u32 = read_u32be(p); + f = u.flt; + + return f; +} +#define RBFL(x) read_fltbe((const uint8_t *)(x)) /** - * Read a 32 bits little endian float out of memory. + * Read a 32 bits little endian float out of memory (single precision). * @param x a pointer to the input memory * @return the corresponding float */ -#define RLFL(x) ((union { uint32_t u; float f; }) { .u = RL32(x) }.f) +static inline float read_fltle(const uint8_t *p) +{ + /* + * Implementor's note: Strictly speaking the "union" trick + * is not portable. But this phrase was found to work on the + * project's supported platforms, and serve well until a more + * appropriate phrase is found. + */ + union { uint32_t u32; float flt; } u; + float f; + + u.u32 = read_u32le(p); + f = u.flt; + + return f; +} +#define RLFL(x) read_fltle((const uint8_t *)(x)) + +/** + * Read a 64 bits big endian float out of memory (double precision). + * @param x a pointer to the input memory + * @return the corresponding floating point value + */ +static inline double read_dblbe(const uint8_t *p) +{ + /* + * Implementor's note: Strictly speaking the "union" trick + * is not portable. But this phrase was found to work on the + * project's supported platforms, and serve well until a more + * appropriate phrase is found. + */ + union { uint64_t u64; double flt; } u; + double f; + + u.u64 = read_u64be(p); + f = u.flt; + + return f; +} + +/** + * Read a 64 bits little endian float out of memory (double precision). + * @param x a pointer to the input memory + * @return the corresponding floating point value + */ +static inline double read_dblle(const uint8_t *p) +{ + /* + * Implementor's note: Strictly speaking the "union" trick + * is not portable. But this phrase was found to work on the + * project's supported platforms, and serve well until a more + * appropriate phrase is found. + */ + union { uint64_t u64; double flt; } u; + double f; + + u.u64 = read_u64le(p); + f = u.flt; + + return f; +} +#define RLDB(x) read_dblle((const uint8_t *)(x)) /** * Write a 8 bits unsigned integer to memory. * @param p a pointer to the output memory * @param x the input unsigned integer */ -#define W8(p, x) do { ((uint8_t*)(p))[0] = (uint8_t) (x); } while (0) +static inline void write_u8(uint8_t *p, uint8_t x) +{ + p[0] = x; +} +#define W8(p, x) write_u8((uint8_t *)(p), (uint8_t)(x)) /** * Write a 16 bits unsigned integer to memory stored as big endian. * @param p a pointer to the output memory * @param x the input unsigned integer */ -#define WB16(p, x) do { ((uint8_t*)(p))[1] = (uint8_t) (x); \ - ((uint8_t*)(p))[0] = (uint8_t)((x)>>8); } while (0) +static inline void write_u16be(uint8_t *p, uint16_t x) +{ + p[1] = x & 0xff; x >>= 8; + p[0] = x & 0xff; x >>= 8; +} +#define WB16(p, x) write_u16be((uint8_t *)(p), (uint16_t)(x)) /** * Write a 16 bits unsigned integer to memory stored as little endian. * @param p a pointer to the output memory * @param x the input unsigned integer */ -#define WL16(p, x) do { ((uint8_t*)(p))[0] = (uint8_t) (x); \ - ((uint8_t*)(p))[1] = (uint8_t)((x)>>8); } while (0) +static inline void write_u16le(uint8_t *p, uint16_t x) +{ + p[0] = x & 0xff; x >>= 8; + p[1] = x & 0xff; x >>= 8; +} +#define WL16(p, x) write_u16le((uint8_t *)(p), (uint16_t)(x)) /** * Write a 32 bits unsigned integer to memory stored as big endian. * @param p a pointer to the output memory * @param x the input unsigned integer */ -#define WB32(p, x) do { ((uint8_t*)(p))[3] = (uint8_t) (x); \ - ((uint8_t*)(p))[2] = (uint8_t)((x)>>8); \ - ((uint8_t*)(p))[1] = (uint8_t)((x)>>16); \ - ((uint8_t*)(p))[0] = (uint8_t)((x)>>24); } while (0) +static inline void write_u32be(uint8_t *p, uint32_t x) +{ + p[3] = x & 0xff; x >>= 8; + p[2] = x & 0xff; x >>= 8; + p[1] = x & 0xff; x >>= 8; + p[0] = x & 0xff; x >>= 8; +} +#define WB32(p, x) write_u32be((uint8_t *)(p), (uint32_t)(x)) /** * Write a 32 bits unsigned integer to memory stored as little endian. * @param p a pointer to the output memory * @param x the input unsigned integer */ -#define WL32(p, x) do { ((uint8_t*)(p))[0] = (uint8_t) (x); \ - ((uint8_t*)(p))[1] = (uint8_t)((x)>>8); \ - ((uint8_t*)(p))[2] = (uint8_t)((x)>>16); \ - ((uint8_t*)(p))[3] = (uint8_t)((x)>>24); } while (0) +static inline void write_u32le(uint8_t *p, uint32_t x) +{ + p[0] = x & 0xff; x >>= 8; + p[1] = x & 0xff; x >>= 8; + p[2] = x & 0xff; x >>= 8; + p[3] = x & 0xff; x >>= 8; +} +#define WL32(p, x) write_u32le((uint8_t *)(p), (uint32_t)(x)) + +/** + * Write a 64 bits unsigned integer to memory stored as little endian. + * @param p a pointer to the output memory + * @param x the input unsigned integer + */ +static inline void write_u64le(uint8_t *p, uint64_t x) +{ + p[0] = x & 0xff; x >>= 8; + p[1] = x & 0xff; x >>= 8; + p[2] = x & 0xff; x >>= 8; + p[3] = x & 0xff; x >>= 8; + p[4] = x & 0xff; x >>= 8; + p[5] = x & 0xff; x >>= 8; + p[6] = x & 0xff; x >>= 8; + p[7] = x & 0xff; x >>= 8; +} +#define WL64(p, x) write_u64le((uint8_t *)(p), (uint64_t)(x)) /** * Write a 32 bits float to memory stored as big endian. * @param p a pointer to the output memory * @param x the input float */ -#define WBFL(p, x) WB32(p, (union { uint32_t u; float f; }) { .f = x }.u) +static inline void write_fltbe(uint8_t *p, float x) +{ + union { uint32_t u; float f; } u; + u.f = x; + write_u32be(p, u.u); +} +#define WBFL(p, x) write_fltbe((uint8_t *)(p), (x)) /** * Write a 32 bits float to memory stored as little endian. * @param p a pointer to the output memory * @param x the input float */ -#define WLFL(p, x) WL32(p, (union { uint32_t u; float f; }) { .f = x }.u) +static inline void write_fltle(uint8_t *p, float x) +{ + union { uint32_t u; float f; } u; + u.f = x; + write_u32le(p, u.u); +} +#define WLFL(p, x) write_fltle((uint8_t *)(p), float (x)) + +/** + * Write a 64 bits float to memory stored as little endian. + * @param p a pointer to the output memory + * @param x the input floating point value + */ +static inline void write_dblle(uint8_t *p, double x) +{ + union { uint64_t u; double f; } u; + u.f = x; + write_u64le(p, u.u); +} +#define WLDB(p, x) write_dblle((uint8_t *)(p), float (x)) + +/* Endianess conversion helpers with read/write position increment. */ + +/** + * Read unsigned 8bit integer from raw memory, increment read position. + * @param[in, out] p Pointer into byte stream. + * @return Retrieved integer value, unsigned. + */ +static inline uint8_t read_u8_inc(const uint8_t **p) +{ + uint8_t v; + + if (!p || !*p) + return 0; + v = read_u8(*p); + *p += sizeof(v); + + return v; +} + +/** + * Read signed 8bit integer from raw memory, increment read position. + * @param[in, out] p Pointer into byte stream. + * @return Retrieved integer value, signed. + */ +static inline int8_t read_i8_inc(const uint8_t **p) +{ + int8_t v; + + if (!p || !*p) + return 0; + v = read_i8(*p); + *p += sizeof(v); + + return v; +} + +/** + * Read unsigned 16bit integer from raw memory (big endian format), increment read position. + * @param[in, out] p Pointer into byte stream. + * @return Retrieved integer value, unsigned. + */ +static inline uint16_t read_u16be_inc(const uint8_t **p) +{ + uint16_t v; + + if (!p || !*p) + return 0; + v = read_u16be(*p); + *p += sizeof(v); + + return v; +} + +/** + * Read unsigned 16bit integer from raw memory (little endian format), increment read position. + * @param[in, out] p Pointer into byte stream. + * @return Retrieved integer value, unsigned. + */ +static inline uint16_t read_u16le_inc(const uint8_t **p) +{ + uint16_t v; + + if (!p || !*p) + return 0; + v = read_u16le(*p); + *p += sizeof(v); + + return v; +} + +/** + * Read signed 16bit integer from raw memory (big endian format), increment read position. + * @param[in, out] p Pointer into byte stream. + * @return Retrieved integer value, signed. + */ +static inline int16_t read_i16be_inc(const uint8_t **p) +{ + int16_t v; + + if (!p || !*p) + return 0; + v = read_i16be(*p); + *p += sizeof(v); + + return v; +} + +/** + * Read signed 16bit integer from raw memory (little endian format), increment read position. + * @param[in, out] p Pointer into byte stream. + * @return Retrieved integer value, signed. + */ +static inline int16_t read_i16le_inc(const uint8_t **p) +{ + int16_t v; + + if (!p || !*p) + return 0; + v = read_i16le(*p); + *p += sizeof(v); + + return v; +} + +/** + * Read unsigned 24bit integer from raw memory (little endian format), increment read position. + * @param[in, out] p Pointer into byte stream. + * @return Retrieved integer value, unsigned. + */ +static inline uint32_t read_u24le_inc(const uint8_t **p) +{ + uint32_t v; + + if (!p || !*p) + return 0; + v = read_u24le(*p); + *p += 3 * sizeof(uint8_t); + + return v; +} + +/** + * Read unsigned 32bit integer from raw memory (big endian format), increment read position. + * @param[in, out] p Pointer into byte stream. + * @return Retrieved integer value, unsigned. + */ +static inline uint32_t read_u32be_inc(const uint8_t **p) +{ + uint32_t v; + + if (!p || !*p) + return 0; + v = read_u32be(*p); + *p += sizeof(v); + + return v; +} + +/** + * Read unsigned 32bit integer from raw memory (little endian format), increment read position. + * @param[in, out] p Pointer into byte stream. + * @return Retrieved integer value, unsigned. + */ +static inline uint32_t read_u32le_inc(const uint8_t **p) +{ + uint32_t v; + + if (!p || !*p) + return 0; + v = read_u32le(*p); + *p += sizeof(v); + + return v; +} + +/** + * Read signed 32bit integer from raw memory (big endian format), increment read position. + * @param[in, out] p Pointer into byte stream. + * @return Retrieved integer value, signed. + */ +static inline int32_t read_i32be_inc(const uint8_t **p) +{ + int32_t v; + + if (!p || !*p) + return 0; + v = read_i32be(*p); + *p += sizeof(v); + + return v; +} + +/** + * Read signed 32bit integer from raw memory (little endian format), increment read position. + * @param[in, out] p Pointer into byte stream. + * @return Retrieved integer value, signed. + */ +static inline int32_t read_i32le_inc(const uint8_t **p) +{ + int32_t v; + + if (!p || !*p) + return 0; + v = read_i32le(*p); + *p += sizeof(v); + + return v; +} + +/** + * Read unsigned 64bit integer from raw memory (big endian format), increment read position. + * @param[in, out] p Pointer into byte stream. + * @return Retrieved integer value, unsigned. + */ +static inline uint64_t read_u64be_inc(const uint8_t **p) +{ + uint64_t v; + + if (!p || !*p) + return 0; + v = read_u64be(*p); + *p += sizeof(v); + + return v; +} + +/** + * Read unsigned 64bit integer from raw memory (little endian format), increment read position. + * @param[in, out] p Pointer into byte stream. + * @return Retrieved integer value, unsigned. + */ +static inline uint64_t read_u64le_inc(const uint8_t **p) +{ + uint64_t v; + + if (!p || !*p) + return 0; + v = read_u64le(*p); + *p += sizeof(v); + + return v; +} + +/** + * Read 32bit float from raw memory (big endian format), increment read position. + * @param[in, out] p Pointer into byte stream. + * @return Retrieved float value. + */ +static inline float read_fltbe_inc(const uint8_t **p) +{ + float v; + + if (!p || !*p) + return 0; + v = read_fltbe(*p); + *p += sizeof(v); + + return v; +} + +/** + * Read 32bit float from raw memory (little endian format), increment read position. + * @param[in, out] p Pointer into byte stream. + * @return Retrieved float value. + */ +static inline float read_fltle_inc(const uint8_t **p) +{ + float v; + + if (!p || !*p) + return 0; + v = read_fltle(*p); + *p += sizeof(v); + + return v; +} + +/** + * Read 64bit float from raw memory (big endian format), increment read position. + * @param[in, out] p Pointer into byte stream. + * @return Retrieved float value. + */ +static inline double read_dblbe_inc(const uint8_t **p) +{ + double v; + + if (!p || !*p) + return 0; + v = read_dblbe(*p); + *p += sizeof(v); + + return v; +} + +/** + * Read 64bit float from raw memory (little endian format), increment read position. + * @param[in, out] p Pointer into byte stream. + * @return Retrieved float value. + */ +static inline double read_dblle_inc(const uint8_t **p) +{ + double v; + + if (!p || !*p) + return 0; + v = read_dblle(*p); + *p += sizeof(v); + + return v; +} + +/** + * Write unsigned 8bit integer to raw memory, increment write position. + * @param[in, out] p Pointer into byte stream. + * @param[in] x Value to write. + */ +static inline void write_u8_inc(uint8_t **p, uint8_t x) +{ + if (!p || !*p) + return; + write_u8(*p, x); + *p += sizeof(x); +} + +/** + * Write unsigned 16bit big endian integer to raw memory, increment write position. + * @param[in, out] p Pointer into byte stream. + * @param[in] x Value to write. + */ +static inline void write_u16be_inc(uint8_t **p, uint16_t x) +{ + if (!p || !*p) + return; + write_u16be(*p, x); + *p += sizeof(x); +} + +/** + * Write unsigned 16bit little endian integer to raw memory, increment write position. + * @param[in, out] p Pointer into byte stream. + * @param[in] x Value to write. + */ +static inline void write_u16le_inc(uint8_t **p, uint16_t x) +{ + if (!p || !*p) + return; + write_u16le(*p, x); + *p += sizeof(x); +} + +/** + * Write unsigned 32bit big endian integer to raw memory, increment write position. + * @param[in, out] p Pointer into byte stream. + * @param[in] x Value to write. + */ +static inline void write_u32be_inc(uint8_t **p, uint32_t x) +{ + if (!p || !*p) + return; + write_u32be(*p, x); + *p += sizeof(x); +} + +/** + * Write unsigned 32bit little endian integer to raw memory, increment write position. + * @param[in, out] p Pointer into byte stream. + * @param[in] x Value to write. + */ +static inline void write_u32le_inc(uint8_t **p, uint32_t x) +{ + if (!p || !*p) + return; + write_u32le(*p, x); + *p += sizeof(x); +} + +/** + * Write unsigned 64bit little endian integer to raw memory, increment write position. + * @param[in, out] p Pointer into byte stream. + * @param[in] x Value to write. + */ +static inline void write_u64le_inc(uint8_t **p, uint64_t x) +{ + if (!p || !*p) + return; + write_u64le(*p, x); + *p += sizeof(x); +} + +/** + * Write single precision little endian float to raw memory, increment write position. + * @param[in, out] p Pointer into byte stream. + * @param[in] x Value to write. + */ +static inline void write_fltle_inc(uint8_t **p, float x) +{ + if (!p || !*p) + return; + write_fltle(*p, x); + *p += sizeof(x); +} + +/** + * Write double precision little endian float to raw memory, increment write position. + * @param[in, out] p Pointer into byte stream. + * @param[in] x Value to write. + */ +static inline void write_dblle_inc(uint8_t **p, double x) +{ + if (!p || !*p) + return; + write_dblle(*p, x); + *p += sizeof(x); +} /* Portability fixes for FreeBSD. */ #ifdef __FreeBSD__ @@ -279,7 +947,7 @@ struct zip_stat; #ifdef __APPLE__ #define SR_DRIVER_LIST_SECTION "__DATA,__sr_driver_list" #else -#define SR_DRIVER_LIST_SECTION "sr_driver_list" +#define SR_DRIVER_LIST_SECTION "__sr_driver_list" #endif /** @@ -756,7 +1424,9 @@ struct sr_serial_dev_inst { #ifdef HAVE_LIBHIDAPI enum ser_hid_chip_t { SER_HID_CHIP_UNKNOWN, /**!< place holder */ + SER_HID_CHIP_BTC_BU86X, /**!< Brymen BU86x */ SER_HID_CHIP_SIL_CP2110, /**!< SiLabs CP2110 */ + SER_HID_CHIP_VICTOR_DMM, /**!< Victor 70/86 DMM cable */ SER_HID_CHIP_WCH_CH9325, /**!< WCH CH9325 */ SER_HID_CHIP_LAST, /**!< sentinel */ } hid_chip; @@ -1034,8 +1704,9 @@ SR_PRIV int std_serial_dev_acquisition_stop(struct sr_dev_inst *sdi); #endif SR_PRIV int std_session_send_df_header(const struct sr_dev_inst *sdi); SR_PRIV int std_session_send_df_end(const struct sr_dev_inst *sdi); -SR_PRIV int std_session_send_frame_begin(const struct sr_dev_inst *sdi); -SR_PRIV int std_session_send_frame_end(const struct sr_dev_inst *sdi); +SR_PRIV int std_session_send_df_trigger(const struct sr_dev_inst *sdi); +SR_PRIV int std_session_send_df_frame_begin(const struct sr_dev_inst *sdi); +SR_PRIV int std_session_send_df_frame_end(const struct sr_dev_inst *sdi); SR_PRIV int std_dev_clear_with_callback(const struct sr_dev_driver *driver, std_dev_clear_callback clear_private); SR_PRIV int std_dev_clear(const struct sr_dev_driver *driver); @@ -1085,6 +1756,10 @@ SR_PRIV int std_double_tuple_idx_d0(const double d, const double a[][2], unsigne SR_PRIV int std_cg_idx(const struct sr_channel_group *cg, struct sr_channel_group *a[], unsigned int n); +SR_PRIV int std_dummy_set_params(struct sr_serial_dev_inst *serial, + int baudrate, int bits, int parity, int stopbits, + int flowcontrol, int rts, int dtr); + /*--- resource.c ------------------------------------------------------------*/ SR_PRIV int64_t sr_file_get_size(FILE *file); @@ -1104,6 +1779,7 @@ SR_PRIV void *sr_resource_load(struct sr_context *ctx, int type, /*--- strutil.c -------------------------------------------------------------*/ SR_PRIV int sr_atol(const char *str, long *ret); +SR_PRIV int sr_atol_base(const char *str, long *ret, char **end, int base); SR_PRIV int sr_atoi(const char *str, int *ret); SR_PRIV int sr_atod(const char *str, double *ret); SR_PRIV int sr_atof(const char *str, float *ret); @@ -1230,7 +1906,6 @@ extern SR_PRIV struct ser_lib_functions *ser_lib_funcs_bt; struct vid_pid_item { uint16_t vid, pid; }; -#define VID_PID_TERM ALL_ZERO struct ser_hid_chip_functions { const char *chipname; @@ -1247,8 +1922,10 @@ struct ser_hid_chip_functions { int (*flush)(struct sr_serial_dev_inst *serial); int (*drain)(struct sr_serial_dev_inst *serial); }; +extern SR_PRIV struct ser_hid_chip_functions *ser_hid_chip_funcs_bu86x; extern SR_PRIV struct ser_hid_chip_functions *ser_hid_chip_funcs_ch9325; extern SR_PRIV struct ser_hid_chip_functions *ser_hid_chip_funcs_cp2110; +extern SR_PRIV struct ser_hid_chip_functions *ser_hid_chip_funcs_victor; SR_PRIV const char *ser_hid_chip_find_name_vid_pid(uint16_t vid, uint16_t pid); #endif #endif @@ -1316,6 +1993,89 @@ SR_PRIV gboolean usb_match_manuf_prod(libusb_device *dev, const char *manufacturer, const char *product); #endif +/*--- binary_helpers.c ------------------------------------------------------*/ + +/** Binary value type */ +enum binary_value_type { + BVT_UINT8 = 0, + BVT_BE_UINT8 = BVT_UINT8, + BVT_LE_UINT8 = BVT_UINT8, + + BVT_BE_UINT16, + BVT_BE_UINT32, + BVT_BE_UINT64, + BVT_BE_FLOAT, + + BVT_LE_UINT16, + BVT_LE_UINT32, + BVT_LE_UINT64, + BVT_LE_FLOAT, +}; + +/** Binary value specification */ +struct binary_value_spec { + /** Offset into binary blob */ + size_t offset; + /** Data type to decode */ + enum binary_value_type type; + /** Scale factor to get native units */ + float scale; +}; + +/** Binary channel definition */ +struct binary_analog_channel { + /** Channel name */ + const char *name; + /** Binary value in data stream */ + struct binary_value_spec spec; + /** Significant digits */ + int digits; + /** Measured quantity */ + enum sr_mq mq; + /** Measured unit */ + enum sr_unit unit; +}; + +/** + * Read extract a value from a binary blob. + * + * @param out Pointer to output buffer. + * @param spec Binary value specification + * @param data Pointer to binary blob + * @param length Size of binary blob + * @return SR_OK on success, SR_ERR_* error code on failure. + */ +SR_PRIV int bv_get_value(float *out, const struct binary_value_spec *spec, const void *data, size_t length); + +/** + * Send an analog channel packet based on a binary analog channel + * specification. + * + * @param sdi Device instance + * @param ch Sigrok channel + * @param spec Channel specification + * @param data Pointer to binary blob + * @param length Size of binary blob + * @return SR_OK on success, SR_ERR_* error code on failure. + */ +SR_PRIV int bv_send_analog_channel(const struct sr_dev_inst *sdi, struct sr_channel *ch, + const struct binary_analog_channel *spec, const void *data, size_t length); + +/*--- crc.c -----------------------------------------------------------------*/ + +#define SR_CRC16_DEFAULT_INIT 0xffffU + +/** + * Calculate a CRC16 checksum using the 0x8005 polynomial. + * + * This CRC16 flavor is also known as CRC16-ANSI or CRC16-MODBUS. + * + * @param crc Initial value (typically 0xffff) + * @param buffer Input buffer + * @param len Buffer length + * @return Checksum + */ +SR_PRIV uint16_t sr_crc16(uint16_t crc, const uint8_t *buffer, int len); /*--- modbus/modbus.c -------------------------------------------------------*/ @@ -1566,6 +2326,34 @@ SR_PRIV gboolean sr_brymen_bm25x_packet_valid(const uint8_t *buf); SR_PRIV int sr_brymen_bm25x_parse(const uint8_t *buf, float *floatval, struct sr_datafeed_analog *analog, void *info); +/*--- dmm/bm52x.c -----------------------------------------------------------*/ + +#define BRYMEN_BM52X_PACKET_SIZE 24 +#define BRYMEN_BM52X_DISPLAY_COUNT 2 + +struct brymen_bm52x_info { size_t ch_idx; }; + +#ifdef HAVE_SERIAL_COMM +SR_PRIV int sr_brymen_bm52x_packet_request(struct sr_serial_dev_inst *serial); +#endif +SR_PRIV gboolean sr_brymen_bm52x_packet_valid(const uint8_t *buf); +SR_PRIV int sr_brymen_bm52x_parse(const uint8_t *buf, float *floatval, + struct sr_datafeed_analog *analog, void *info); + +/*--- dmm/bm86x.c -----------------------------------------------------------*/ + +#define BRYMEN_BM86X_PACKET_SIZE 24 +#define BRYMEN_BM86X_DISPLAY_COUNT 2 + +struct brymen_bm86x_info { size_t ch_idx; }; + +#ifdef HAVE_SERIAL_COMM +SR_PRIV int sr_brymen_bm86x_packet_request(struct sr_serial_dev_inst *serial); +#endif +SR_PRIV gboolean sr_brymen_bm86x_packet_valid(const uint8_t *buf); +SR_PRIV int sr_brymen_bm86x_parse(const uint8_t *buf, float *floatval, + struct sr_datafeed_analog *analog, void *info); + /*--- dmm/ut71x.c -----------------------------------------------------------*/ #define UT71X_PACKET_SIZE 11 @@ -1640,6 +2428,33 @@ SR_PRIV gboolean es51919_packet_valid(const uint8_t *pkt); SR_PRIV int es51919_packet_parse(const uint8_t *pkt, float *floatval, struct sr_datafeed_analog *analog, void *info); +/*--- lcr/vc4080.c ----------------------------------------------------------*/ + +/* Note: Also uses 'struct lcr_parse_info' from es51919 above. */ + +#define VC4080_PACKET_SIZE 39 +#define VC4080_COMM_PARAM "1200/8n1" +#define VC4080_WITH_DQ_CHANS 0 /* Enable separate D/Q channels? */ + +enum vc4080_display { + VC4080_DISPLAY_PRIMARY, + VC4080_DISPLAY_SECONDARY, +#if VC4080_WITH_DQ_CHANS + VC4080_DISPLAY_D_VALUE, + VC4080_DISPLAY_Q_VALUE, +#endif + VC4080_CHANNEL_COUNT, +}; + +extern SR_PRIV const char *vc4080_channel_formats[VC4080_CHANNEL_COUNT]; + +SR_PRIV int vc4080_config_list(uint32_t key, GVariant **data, + const struct sr_dev_inst *sdi, const struct sr_channel_group *cg); +SR_PRIV int vc4080_packet_request(struct sr_serial_dev_inst *serial); +SR_PRIV gboolean vc4080_packet_valid(const uint8_t *pkt); +SR_PRIV int vc4080_packet_parse(const uint8_t *pkt, float *floatval, + struct sr_datafeed_analog *analog, void *info); + /*--- dmm/ut372.c -----------------------------------------------------------*/ #define UT372_PACKET_SIZE 27 @@ -1715,10 +2530,8 @@ struct eev121gw_info { extern SR_PRIV const char *eev121gw_channel_formats[]; SR_PRIV gboolean sr_eev121gw_packet_valid(const uint8_t *buf); -SR_PRIV int sr_eev121gw_parse(const uint8_t *buf, float *floatval, - struct sr_datafeed_analog *analog, void *info); SR_PRIV int sr_eev121gw_3displays_parse(const uint8_t *buf, float *floatval, - struct sr_datafeed_analog *analog, void *info); + struct sr_datafeed_analog *analog, void *info); /*--- scale/kern.c ----------------------------------------------------------*/ @@ -1744,7 +2557,7 @@ struct sr_sw_limits { uint64_t start_time; }; -SR_PRIV int sr_sw_limits_config_get(struct sr_sw_limits *limits, uint32_t key, +SR_PRIV int sr_sw_limits_config_get(const struct sr_sw_limits *limits, uint32_t key, GVariant **data); SR_PRIV int sr_sw_limits_config_set(struct sr_sw_limits *limits, uint32_t key, GVariant *data); @@ -1756,4 +2569,25 @@ SR_PRIV void sr_sw_limits_update_frames_read(struct sr_sw_limits *limits, uint64_t frames_read); SR_PRIV void sr_sw_limits_init(struct sr_sw_limits *limits); +/*--- feed_queue.h ----------------------------------------------------------*/ + +struct feed_queue_logic; +struct feed_queue_analog; + +SR_API struct feed_queue_logic *feed_queue_logic_alloc( + struct sr_dev_inst *sdi, + size_t sample_count, size_t unit_size); +SR_API int feed_queue_logic_submit(struct feed_queue_logic *q, + const uint8_t *data, size_t count); +SR_API int feed_queue_logic_flush(struct feed_queue_logic *q); +SR_API void feed_queue_logic_free(struct feed_queue_logic *q); + +SR_API struct feed_queue_analog *feed_queue_analog_alloc( + struct sr_dev_inst *sdi, + size_t sample_count, int digits, struct sr_channel *ch); +SR_API int feed_queue_analog_submit(struct feed_queue_analog *q, + float data, size_t count); +SR_API int feed_queue_analog_flush(struct feed_queue_analog *q); +SR_API void feed_queue_analog_free(struct feed_queue_analog *q); + #endif