janky bitreader, usercmdinfo almost finished

1 files changed, 41 insertions, 0 deletions

diff --git a/utils/bitreader.go b/utils/bitreader.go
new file mode 100644
index 0000000..c4936fd
--- /dev/null
+++ b/utils/bitreader.go
@@ -0,0 +1,41 @@
+package utils
+
+import (
+        "fmt"
+        "math"
+        "strconv"
+)
+
+func ReadBitStateLSB(input byte, index int) (bool, error) {
+        if index < 0 && index > 7 {
+                return false, fmt.Errorf("IndexOutOfBounds for type byte")
+        }
+        value := input & (1 << index)
+        return (value > 0), nil
+}
+
+func Read32BitsAfterFirstBitInt32(input []byte, index int, step int) int32 {
+        binary := ""
+        binary += fmt.Sprintf("%08b", input[step])[8-index : 8]
+        binary += fmt.Sprintf("%08b", input[step-1])
+        binary += fmt.Sprintf("%08b", input[step-2])
+        binary += fmt.Sprintf("%08b", input[step-3])
+        binary += fmt.Sprintf("%08b", input[step-4])[:8-index]
+        output, err := strconv.ParseInt(binary, 2, 32)
+        CheckError(err)
+        return int32(output)
+
+}
+
+func Read32BitsAfterFirstBitFloat32(input []byte, index int, step int) float32 {
+        binary := ""
+        binary += fmt.Sprintf("%08b", input[step])[8-index : 8]
+        binary += fmt.Sprintf("%08b", input[step-1])
+        binary += fmt.Sprintf("%08b", input[step-2])
+        binary += fmt.Sprintf("%08b", input[step-3])
+        binary += fmt.Sprintf("%08b", input[step-4])[:8-index]
+        output, err := strconv.ParseUint(binary, 2, 32)
+        CheckError(err)
+        return math.Float32frombits(uint32(output))
+
+}