Ported IMU-Related Code from C++ to C. (Almost) Ready to be ported to
Linux Kernel. Missing <float> type handling.