summaryrefslogtreecommitdiffstats
path: root/src/canutil/read.c
blob: 3931721afec54826c3a57b6a1362d00cc3f42a42 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
#include <canutil/read.h>
#include <bitfield/bitfield.h>
#include <bitfield/8byte.h>

float eightbyte_parse_float(uint64_t data, uint8_t bit_offset, uint8_t bit_size,
        float factor, float offset) {
    uint64_t raw = eightbyte_get_bitfield(data, bit_offset, bit_size, true);
    return raw * factor + offset;
}

bool eightbyte_parse_bool(uint64_t data, uint8_t bit_offset, uint8_t bit_size,
        float factor, float offset) {
    float value = eightbyte_parse_float(data, bit_offset, bit_size, factor, offset);
    return value == 0.0 ? false : true;
}

float bitfield_parse_float(const uint8_t source[], const uint16_t source_length,
        const uint8_t bit_offset, const uint8_t bit_size, const float factor,
        const float offset) {
    uint64_t raw = get_bitfield(source, source_length, bit_offset, bit_size);
    // TODO seems dumb that this is repeated from eightbyte_parse_float - is it
    // really worth keeping around these two implementations?
    return raw * factor + offset;
}

float bitfield_parse_bool(const uint8_t source[], const uint16_t source_length,
        const uint8_t bit_offset, const uint8_t bit_size, const float factor,
        const float offset) {
    float value = bitfield_parse_float(source, source_length, bit_offset,
            bit_size, factor, offset);
    return value == 0.0 ? false : true;
}