Added angles (roll, pitch, yaw) calculation to IMU