added avoidance timeout and pivot must be in tolerance for 5 steps. also updated nav filter