实现机器人基本轨迹的拼接，对轨迹要求不高的，理论上可以实现任何轨迹（需要提前安装robotic toolbox）(To achieve the basic trajectory of robot splicing, the trajectory is not high enough, in theory can achieve any trajectory (need to install robotic toolbox in adva