Issue #274: Reset odometry also for heading