求取四个点的DMP参数，然后插值得到最终轨迹

下一步目标是在目标在线移动时新的轨迹的生成