add no heading update during collision avoidance, add encoder slip detection for encoder failure