第 4 章机器人轨迹规划本章在操作臂运动学和动力学的基础上，讨论在关节空间和笛卡尔空间中机器人运动的轨迹规划和轨迹生成方法。所谓轨迹，是指操作臂在运动过程中的位移、速度和加速度而轨迹规划是根据作业任务的要求，计算出预期的运动轨迹。首先对机器人的任务，运动路径和轨迹进行描述，轨迹规划器可使编程手续简化，只要求用户输入有关路径和轨迹的若干约束和简单描述，而复杂的细节问题则由规划器解决。例如，用户只需给出手部的目标位姿，让规划器确定到达该目标的路径点、持续时间、运动速度等轨迹参数。并且，在计算机内部描述所要求的轨迹，即选择习惯规定及合理的软件数据结构。最后，对内部描述的轨迹、实时计算机器人运动的位移、速度和加速度，生成运动轨迹。4.1 机器人轨迹规划概述一、机器人轨迹的概念机器人轨迹泛指工业机器人在运动过程中的运动轨迹，即运动点的位移、速度和加速度。机器人在作业空间要完成给定的任务，其手部运动必须按一定的轨迹(trajectory)进行。轨迹的生成一般是先给定轨迹上的若干个点，将其经运动学反解映射到关节空间，对关节空间中的相应点建立运动方程，然后按这些运动方程对关节进行插值，从而实现作业空间的运动要求，这一过程通常称为轨迹规划。工业机器人轨迹规划属于机器人低层规划，基本上不涉及人工智能的问题，本章仅讨论在关节空间或笛卡尔空间中工业机器人运动的轨迹规划和轨迹生成方法。机器人运动轨迹的描述一般是对其手部位姿的描述，此位姿值可与关节变量相互转换。控制轨迹也就是按时间控制手部或工具中心走过的空间路径。二、轨迹规划的一般性问题通常将操作臂的运动看作是工具坐标系｛T｝相对于工件坐标系｛S｝的一系列运动。这种描述方法既适用于各种操作臂，也适用于同一操作臂上装夹的各种工具。对于移动工作台(例如传送带)，这种方法同样适用。这时，工作坐标｛S｝位姿随时间而变化。例如，图 4.1 所示将销插入工件孔中的作业可以借助工具坐标系的一系列位姿图 4.1 机器人将销插入工件孔中的作业描述P.（i=1,2,…，n）来描述。这种描述方法不仅符合机器人用户考虑问题的思路，而且有利于描述和生成机器人的运动轨迹。用工具坐标系相对于工件坐标系的运动来描述作业路径是一种通用的作业描述方法。它把作业路径描述与具体的机器人、手爪或工具分离开来，形成了模型化的作业描述方法，从而使这种描述既适用于不同的机器人，也适用于在同一机器人上装夹不同规格的工具。在...
