用时需要将x,y,z,以及下面的雅克比矩阵换为自己机器人的参数,以及需要提前设定好轨迹,也可将轨迹改为单点。
1