精品课件川教版信息技术九下第10课《轨迹机器人》ppt课件

第第3 3章章 机器人轨迹规划机器人轨迹规划 3.1 3.1 机器人轨迹规划概述机器人轨迹规划概述 3.1.1 3.1.1 机器人轨迹的概念机器人轨迹的概念 轨迹：点的轨迹、位移、速度和加速度。轨迹：点的轨迹、位移、速度和加速度。 轨迹规划：将手部运动轨迹换算成关节空间；轨迹规划：将手部运动轨迹换算成关节空间； 对关节空间进行插值。对关节空间进行插值。 3.1.2 3.1.2 轨迹规划的一般性问题轨迹规划的一般性问题 通用作业描述方法通用作业描述方法: : （1 1）描述成工具坐标系）描述成工具坐标系 T T 相对于工件坐标系相对于工件坐标系 S S 3.1.2 3.1.2 轨迹规划的一般性问题轨迹规划的一般性问题 通用作业描述方法通用作业描述方法: : （1 1）描述成工具坐标系）描述成工具坐标系 T T 相对于工件坐标系相对于工件坐标系 S S 的一系列运动。的一系列运动。 （2 2）轨迹的点：包含位置和姿态；）轨迹的点：包含位置和姿态； （3 3）插值的原则：保证运动平稳。即位移、）插值的原则：保证运动平稳。即位移、 速度函数必须连续，有时甚至加速度也要求连续速度函数必须连续，有时甚至加速度也要求连续 。 （4 4）关节空间插值：将所有关节变量表示为）关节空间插值：将所有关节变量表示为 时间的函数，用这些关节函数及其一阶、二阶导时间的函数，用这些关节函数及其一阶、二阶导 数描述机器人预期的运动；数描述机器人预期的运动； （5 5）直角坐标空间插值：将手爪位姿、速度）直角坐标空间插值：将手爪位姿、速度 和加速度表示为时间的函数，再算出所有关节位和加速度表示为时间的函数，再算出所有关节位 置、速度和加速度函数值。置、速度和加速度函数值。 3.1.4 3.1.4 轨迹规划涉及的主要问题轨迹规划涉及的主要问题 轨迹规划一般过程：轨迹规划一般过程： (1) (1) 作业描述：（用示教方法）给出轨迹上的若干作业描述：（用示教方法）给出轨迹上的若干 个结点。个结点。 (2) (2) 插值：在结点之间进行插补，得到直角空间的插值：在结点之间进行插补，得到直角空间的 X X( (t t) )或关节空间的位移或关节空间的位移q q( (t t) )； (3) (3) 以以X X( (t t) )或或q q( (t t) ) 为依据设计控制规律。为依据设计控制规律。 (4) (4) 考虑路径上是否存在障碍。考虑路径上是否存在障碍。 3.2 3.2 插补方式分类与轨迹控制插补方式分类与轨迹控制 3.2.1 3.2.1 插补方式分类插补方式分类 点位控制点位控制(PTP(PTP控制控制) )：只要求起终点位姿，没有路：只要求起终点位姿，没有路 径约束。径约束。 插补的依据是（插补的依据是（1 1）关节最大速度和加速度；（）关节最大速度和加速度；（2 2） 速度连续，各轴协调。速度连续，各轴协调。 连续轨迹控制连续轨迹控制(CP(CP控制控制) )：有路径约束，要对路径进：有路径约束，要对路径进 行设计。行设计。 路径控制与插补方式分类路径控制与插补方式分类 不插不插补补补补关关节节节节插插补补补补( (平滑平滑) )空空间间间间插插补补补补 PTPPTP (1) (1) 各各轴轴轴轴独立独立 快速到达。快速到达。 (2) (2) 关关节节节节最大最大 加速度限制加速度限制 (1) (1) 各各轴协调轴协调轴协调轴协调 运运动动动动定定时时时时 插插补补补补。 (2) (2) 各关各关节节节节最大加速度最大加速度 限制限制 CPCP (1) (1) 在空在空间间间间插插补补补补点点间进间进间进间进 行关行关节节节节定定时时时时插插补补补补。 (2) (2) 用关用关节节节节的低的低阶阶阶阶多多项项项项 式式拟拟拟拟合空合空间间间间直直线线线线使各使各 轴协调轴协调轴协调轴协调 运运动动动动。 (3) (3) 关关节节节节最大加速度限最大加速度限 制制 (1) (1) 直直线线线线、圆圆圆圆弧弧 、曲、曲线线线线等距插等距插补补补补 。 (2)(2)给给给给定起停定起停线线线线 速度、速度、线线线线加速度加速度 ；关；关节节节节速度、加速度、加 速度限制速度限制 3.2.2 3.2.2 机器人轨迹控制过程（机器人轨迹控制过程（示教示教- -再现过程）：再现过程）： （1 1）对于有规律的轨迹，仅示教几个特征点，如）对于有规律的轨迹，仅示教几个特征点，如 直线需要示教两点，圆弧需要示教三点；直线需要示教两点，圆弧需要示教三点； （2 2）计算机利用插补算法获得中间点的坐标；）计算机利用插补算法获得中间点的坐标； （3 3）计算机求出）计算机求出 ( ( 1 1 , , , , n n ) ) ， （4 4）闭环控制系统实现预期轨迹。）闭环控制系统实现预期轨迹。 3.3 3.3 机器人轨迹插值计算机器人轨迹插值计算 给出结点（位置姿态）；进行运动学反解；关节给出结点（位置姿态）；进行运动学反解；关节 变量的插值计算。变量的插值计算。 3.3.1 3.3.1 直线插补直线插补 直线插补和圆弧插补是机器人系统中的基本插补直线插补和圆弧插补是机器人系统中的基本插补 算法。对于其他轨迹，可以采用直线或圆弧逼近，以算法。对于其他轨迹，可以采用直线或圆弧逼近，以 实现这些轨迹。实现这些轨迹。 已知（示教给出）直线始末两点的坐标值已知（示教给出）直线始末两点的坐标值P P 0 0 ( (X X 0 0 ，Y Y 0 0 ， Z Z0 0 ) )、P P e e ( (X X e e ，Y Y e e ，Z Z e e ) )及姿态，要求走空间直线：及姿态，要求走空间直线： 求各轨迹中间点求各轨迹中间点( (插补点插补点) )的位置和姿态。的位置和姿态。 设设v v为要求的沿直线运动的速度；为要求的沿直线运动的速度；t t s s 为插补时间间隔。为插补时间间隔。 t t s s 间隔内行程：间隔内行程：d d = = vt vt s s ； 插补总步数插补总步数N N：L L/ /d d+1+1，取整；，取整； 各插补点坐标值各插补点坐标值各坐标轴增量各坐标轴增量 直线长度：直线长度： 3.3.2 3.3.2 圆弧插补圆弧插补 一、平面圆弧插补（圆弧在坐标平面内）一、平面圆弧插补（圆弧在坐标平面内） 已知（示教给出）不在一条直线上的三点已知（示教给出）不在一条直线上的三点P P 1 1 、 P P2 2 、P P 3 3 及对应姿态。及对应姿态。 求各轨迹中间点求各轨迹中间点( (插补点插补点) )的位置和姿态。的位置和姿态。 设设v v为沿圆弧运动速度；为沿圆弧运动速度；t t s s 为插补时时间隔。为插补时时间隔。 (1) (1) 计算计算P P 1 1 、P P 2 2 、P P 3 3 决定的圆弧半径决定的圆弧半径R R。 (2)(2)计算总的圆心角计算总的圆心角 = = 1 1+ + 2 2 : : (3) (3) t t s s 时间内角位移量：时间内角位移量： = =t t s s v v/ /R R， (4) (4) 总插补步数总插补步数( (取整数取整数) )：N N = = / / + 1+ 1 式中：式中：X X i i = =R R coscos i i ；Y Y i i = =R Rsinsin i i 。 二、空间圆弧插补二、空间圆弧插补 空间圆弧插补可分三步来处理：空间圆弧插补可分三步来处理： (1) (1) 把三维问题转化成二维，找出圆弧所在平面。把三维问题转化成二维，找出圆弧所在平面。 (2) (2) 利用二维平面插补算法求出插补点坐标利用二维平面插补算法求出插补点坐标( (X Xi i+1 +1, , Y Yi i+1 +1) )。 。 (3) (3) 把该点的坐标值转变为基础坐标系下的值。把该点的坐标值转变为基础坐标系下的值。 3.3.3 3.3.3 定时插补与定距插补定时插补与定距插补 一、定时插补一、定时插补 t t s s 与精度有关：与精度有关： t t s s 的上限值：受刚度限制，的上限值：受刚度限制，t t s s 一般不超过一般不超过25 ms25 ms t t s s 的下限值：受计算量限制（计算机要在的下限值：受计算量限制（计算机要在t t s s 时间时间 里完成一次插补运算和一次逆向运动学计算）。约里完成一次插补运算和一次逆向运动学计算）。约 需几毫秒。需几毫秒。 二、定距插补二、定距插补 两插补点的距离两插补点的距离P P i i P P i i+1+1恒为一个足够小的值， 恒为一个足够小的值， 以保证轨迹精度，以保证轨迹精度，t t s s 就要变化。就要变化。 3.3.4 3.3.4 关节空间插补关节空间插补 给定：机器人在起始点和终止点手臂的位形。给定：机器人在起始点和终止点手臂的位形。 可以给出：首末两点的力、速度和加速度的要可以给出：首末两点的力、速度和加速度的要 求；求； 插值依据：关节位移、速度、加速度连续性；插值依据：关节位移、速度、加速度连续性； 关节变量的容许范围等。关节变量的容许范围等。 一、三次多项式插值一、三次多项式插值 二、过路径点的三次多项式插值二、过路径点的三次多项式插值 三、高阶多项式插值 若对于运动轨迹的要求更为严格，约束条件增多， 三次多项式就不能满足需要，须用更高阶的多项式对运 动轨迹的路径段进行插值。 例如:起始点和终止点都规定了关节的位置、速度和 加速度，则要用一个五次多项式进行插值。 四、用抛物线过渡的线性插值四、用抛物线过渡的线性插值 3.4 3.4 机器人手部路径的轨迹规划机器人手部路径的轨迹规划 3.4.2 3.4.2 作业的描述作业的描述 3.4 3.4 机器人手部路径的轨迹规划机器人手部路径的轨迹规划 3.4.2 3.4.2 作业的描述作业的描述 结结结结点点 P P0 0 P P1 1 P P2 2 P P2 2 运运动动动动INITINITMOVE