use Vectors in the interface between state/motionplanner