src/binary_helpers.c

   1 /*
   2  * This file is part of the libsigrok project.
   3  *
   4  * Copyright (C) 2020 Andreas Sandberg <andreas@sandberg.pp.se>
   5  *
   6  * This program is free software: you can redistribute it and/or modify
   7  * it under the terms of the GNU General Public License as published by
   8  * the Free Software Foundation, either version 3 of the License, or
   9  * (at your option) any later version.
  10  *
  11  * This program is distributed in the hope that it will be useful,
  12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  14  * GNU General Public License for more details.
  15  *
  16  * You should have received a copy of the GNU General Public License
  17  * along with this program.  If not, see <http://www.gnu.org/licenses/>.
  18  */
  19
  20 #include <config.h>
  21 #include <glib.h>
  22 #include <libsigrok/libsigrok.h>
  23 #include "libsigrok-internal.h"
  24
  25 SR_PRIV int bv_get_value_len(float *out, const struct binary_value_spec *spec,
  26         const uint8_t *data, size_t length)
  27 {
  28         float value;
  29
  30         if (!out || !spec || !data)
  31                 return SR_ERR_ARG;
  32
  33 #define VALUE_TYPE(T, R, L)                             \
  34         case T:                                         \
  35                 if (spec->offset + (L) > length)        \
  36                         return SR_ERR_DATA;             \
  37                 value = R(data + spec->offset);         \
  38                 break
  39
  40         switch (spec->type) {
  41         VALUE_TYPE(BVT_UINT8, read_u8, sizeof(uint8_t));
  42
  43         VALUE_TYPE(BVT_BE_UINT16, read_u16be, sizeof(uint16_t));
  44         VALUE_TYPE(BVT_BE_UINT24, read_u24be, 3 * sizeof(uint8_t));
  45         VALUE_TYPE(BVT_BE_UINT32, read_u32be, sizeof(uint32_t));
  46         VALUE_TYPE(BVT_BE_UINT64, read_u64be, sizeof(uint64_t));
  47         VALUE_TYPE(BVT_BE_FLOAT,  read_fltbe, sizeof(float));
  48
  49         VALUE_TYPE(BVT_LE_UINT16, read_u16le, sizeof(uint16_t));
  50         VALUE_TYPE(BVT_LE_UINT24, read_u24le, 3 * sizeof(uint8_t));
  51         VALUE_TYPE(BVT_LE_UINT32, read_u32le, sizeof(uint32_t));
  52         VALUE_TYPE(BVT_LE_UINT64, read_u64le, sizeof(uint64_t));
  53         VALUE_TYPE(BVT_LE_FLOAT,  read_fltle, sizeof(float));
  54
  55         default:
  56                 return SR_ERR_ARG;
  57         }
  58
  59 #undef VALUE_TYPE
  60
  61         if (out)
  62                 *out = value;
  63         return SR_OK;
  64 }