IMU earth self alignment update - Still in development