X-Git-Url: https://sigrok.org/gitweb/?p=libsigrok.git;a=blobdiff_plain;f=src%2Fbinary_helpers.c;h=14196110475e00c34d66bdb32d194587437af307;hp=f9b6655de87745af5c1e1e295a3c223a85a42f33;hb=HEAD;hpb=d555959df03e3a51a4a610fde82520df69e3541e diff --git a/src/binary_helpers.c b/src/binary_helpers.c index f9b6655d..14196110 100644 --- a/src/binary_helpers.c +++ b/src/binary_helpers.c @@ -22,8 +22,8 @@ #include #include "libsigrok-internal.h" -SR_PRIV int bv_get_value(float *out, const struct binary_value_spec *spec, - const void *data, size_t length) +SR_PRIV int bv_get_value_len(float *out, const struct binary_value_spec *spec, + const uint8_t *data, size_t length) { float value; @@ -41,14 +41,12 @@ SR_PRIV int bv_get_value(float *out, const struct binary_value_spec *spec, VALUE_TYPE(BVT_UINT8, read_u8, sizeof(uint8_t)); VALUE_TYPE(BVT_BE_UINT16, read_u16be, sizeof(uint16_t)); + VALUE_TYPE(BVT_BE_UINT24, read_u24be, 3 * sizeof(uint8_t)); VALUE_TYPE(BVT_BE_UINT32, read_u32be, sizeof(uint32_t)); - VALUE_TYPE(BVT_BE_UINT64, read_u64be, sizeof(uint64_t)); - VALUE_TYPE(BVT_BE_FLOAT, read_fltbe, sizeof(float)); VALUE_TYPE(BVT_LE_UINT16, read_u16le, sizeof(uint16_t)); + VALUE_TYPE(BVT_LE_UINT24, read_u24le, 3 * sizeof(uint8_t)); VALUE_TYPE(BVT_LE_UINT32, read_u32le, sizeof(uint32_t)); - VALUE_TYPE(BVT_LE_UINT64, read_u64le, sizeof(uint64_t)); - VALUE_TYPE(BVT_LE_FLOAT, read_fltle, sizeof(float)); default: return SR_ERR_ARG; @@ -60,3 +58,42 @@ SR_PRIV int bv_get_value(float *out, const struct binary_value_spec *spec, *out = value; return SR_OK; } + +SR_PRIV int bv_get_value(float *out, const struct binary_value_spec *spec, + const uint8_t *data) +{ + float value; + const uint8_t *ptr; + + ptr = &data[spec->offset]; + + switch (spec->type) { + case BVT_UINT8: + value = read_u8(ptr); + break; + case BVT_BE_UINT16: + value = read_u16be(ptr); + break; + case BVT_BE_UINT24: + value = read_u24be(ptr); + break; + case BVT_BE_UINT32: + value = read_u32be(ptr); + break; + case BVT_LE_UINT16: + value = read_u16le(ptr); + break; + case BVT_LE_UINT24: + value = read_u24le(ptr); + break; + case BVT_LE_UINT32: + value = read_u32le(ptr); + break; + default: + return SR_ERR_ARG; + } + + if (out) + *out = value; + return SR_OK; +}