DMP测试

一维DMP的误差问题在三维上发生扩大
三维DMP轨迹学习完成

通过inv参数，使工具箱的ikine能够得到解
运动目标跟踪，基本有谱了

运动目标可以跟踪，下一步就是解决误差和插值问题