Work done on allowing Navigator to work with distance PID control