indigo version of the cartesian path planner. Same as hydro except added different yaml parsing