Add sensor fusion algorithm to the internal IMU

Currently, only raw data from the IMU is available, implementing a sensor fusion algorithm further simplifies Open-Cube usage for the user.

assigned to @jelinva4