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))

}