ptp速度规划

SCARA 机器人点到点（PTP）轨迹规划方法设起始位姿为 T_s，目标位姿为 T_f，通过逆运动学求得：θ_s = IK(T_s)θ_f = IK(T_f)

我是有底线的