added goal_time_tolerance, precision, velocity checks