Functions
def compress_quaternion(quat)
Compress a quaternion. assumes input quaternion is normalized. will fail if not.
see quatcompress.h in firmware the for definitions
Args: quat : An array of floats representing a quaternion [x, y, z, w]
Returns: 32-bit integer
def decompress_quaternion(comp)
Decompress a quaternion
see quatcompress.h in the firmware for definitions
Args: comp int: A 32-bit number
Returns: np array: q = [x, y, z, w]
def fp16_to_float(float16)