IMU homemade sensor fusion