summaryrefslogtreecommitdiffstats
path: root/src/canutil/write.c
blob: 64b5729750b32b3d56d9760c513116280c909005 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
#include "write.h"
#include <bitfield/bitfield.h>

uint64_t encodeFloat(float value, uint8_t bitPosition, uint8_t bitSize,
        float factor, float offset) {
    float rawValue = (value - offset) / factor;
    if(rawValue > 0) {
        // round up to avoid losing precision when we cast to an int
        rawValue += 0.5;
    }
    uint64_t result = 0;
    setBitField(&result, (uint64_t)rawValue, bitPosition, bitSize);
    return result;
}

uint64_t encodeBoolean(bool value, uint8_t bitPosition, uint8_t bitSize,
        float factor, float offset) {
    return encodeFloat(value, offset, factor, bitPosition, bitSize);
}