Changed Paths to hold KnotPoints and KnotPoints to contain a MotionState. Once we implement the
stop operator with reflexxes, this will enable us to hold both a motion
state and a time to stop at a knot point.