Fix: The robot should no longer get stuck while calibrating heading