Planner slightly faster and independent on ros