Fixed gimbal lock in IMU angular rates formula