Added new jitter function using only PlannerParameters configuration, update constraint planner