Data fusion of gyro and accelerometer for one IMU - View it on GitHub