Initial commit, pulled from openxc/vi-firmware.

1 files changed, 18 insertions, 0 deletions

diff --git a/src/canutil/write.c b/src/canutil/write.c
new file mode 100644
index 00000000..fdcba1f5
--- /dev/null
+++ b/src/canutil/write.c
@@ -0,0 +1,18 @@
+#include "write.h"
+
+uint64_t encodeFloat(float value, float offset, float factor, uint8_t bitPosition,
+        uint8_t bitSize) {
+    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, rawValue, bitPosition, bitSize);
+    return result;
+}
+
+uint64_t encodeBoolean(bool value, float offset, float factor,
+                uint8_t bitPosition, uint8_t bitSize) {
+        return encodeFloat(value, offset, factor, bitPosition, bitSize);
+}