机器人技术第5讲

2020 4 19 1 第四章机器人动力学 机器人是主动机械装置 原则上 它的每个自由度都具有单独传动 从控制的观点来看 机械手系统是冗余 多变量和本质非线性的自动控制系统 也是复杂的动力学耦合系统 每个控制任务本身就是一个动力学任务 因此研究机器人的动力学问题就是为了进一步讨论控制问题 为使机器人连杆加速 驱动器必须有足够大的力和力矩来驱动机器人连杆和关节 以使他们能以期望的加速度和速度运动 否则连杆将因运动迟缓而损失机器人的位置精度 因此必须建立决定机器人运动的动力学关系方程 用来计算每个驱动器所需的驱动力 2020 4 19 2 第四章机器人动力学 方法 1牛顿 欧拉法 2拉格朗日方法 机器人动力学方程可以确定机器人的运动 但实际上除最简单的情况外 求解机器人的全部动力学方程几乎是不可能的 作用 1确定力和力矩 以便在机器人连杆和关节上产生期望的加速度 2考察不同负载对机器人的影响及根据期望的加速度来考察某些负载的重要性 2020 4 19 3 第四章机器人动力学 牛顿欧拉法从运动学出发求得加速度 并消去各内作用力 拉格朗日方法 它只需要速度而不必求内作用力 是比较直接的方法 对于动力学 有两个相反的问题 一是动力学的正问题 已知机械手各关节的作用力或力矩 求各关节的位移 速度和加速度 主要应用于仿真研究 二是动力学的逆问题 已知机械手的运动轨迹 即各关节的位移 速度 加速度求各关节所需要的驱动力或力矩 主要是实时控制的需要 一般机器人的动态方程由6个非线性微分方程联立表示 实际上除了一些简单的情况外 不可能求得方程的一般解 在实际控制时往往对动态方程作出某些假设 进行简化处理 2020 4 19 4 4 1惯性矩 首先 在图4 1里通过把质点的平移运动改作回转运动的分析 来了解惯性矩的物理意义 若将力F作用到质量为m的质点时的平移运动 看作是运动方向的标量 则可以表示为 式中 表示加速度 若把这一运动看作是质量可以忽略的棒长为r的回转运动 则得到加速度和力的关系式为 2020 4 19 5 4 1惯性矩 式中 和N是绕轴回转的角加速度和惯性力矩 将和F代入上式得 令 上式可以变为 4 1 式 4 1 是质点绕固定轴进行回转运动时的运动方程式 I相当于平动时的质量 称为惯性矩 求质量连续分布物体的惯性矩时 可以将其分割成假想的微小物体 然后将微小物体的惯性矩加在一起 这时 微小物体的质量dm及其微小物体体积dV的关系可用密度 表示为 2020 4 19 6 4 1惯性矩 那么 它的惯性矩为 整个物体的惯性矩可用下式表示 4 2 例4 1求图4 2所示质量为M 长度为L的匀质杆 粗细忽略 绕其一端回转时的惯性矩I 2020 4 19 7 4 1惯性矩 例4 2试求上例的杆绕重心回转时的惯性矩IC 解 由于该杆是重心位于中心的匀质杆 因此 可先就杆的一半来求解 然后再加倍即可 假定x为离杆中心的距离 则得到 解 微小物体的质量用线密度 M L 表示 所以其惯性矩为 因此将dI在长度方向积分 即可得到 2020 4 19 8 4 2牛顿 欧拉运动方程式 图4 3所示的单一刚体的运动方程式可用下式来表示 4 3 式中 m 标量 是刚体的质量 是绕重心C的惯性矩阵 FC是作用于重心的平动力 N是惯性力矩 Vc是重心的平移速度 为角速 度 式 4 3 及式 4 4 分别被称为牛顿运动方程式及欧拉运动方程式 Ic的各元素表示对应的力矩元素和角加速度元素间的惯性矩 4 4 2020 4 19 9 4 2牛顿 欧拉运动方程式 下面我们来求图4 4所示1自由度机械手的运动方程式 这种场合 由于关节轴制约连杆的运动 所以可以把式 4 4 的运动方程式看作是绕固定轴的运动 假定绕关节轴的惯性矩为I 取垂直纸面的方向为Z轴 则得到 2020 4 19 10 4 2牛顿 欧拉运动方程式 式中 g为重力常数 是在第三行第三列上具有绕关节轴的惯性矩阵 把这些公式代入 4 4 提取只有z分量的回转则得到 2020 4 19 11 4 2牛顿 欧拉运动方程式 式中 4 5 对于一般形式的连杆 由于I 除第三分量以外 其它分量皆不为零 所以 I 不是零向量 I 的第1 2分量成了改变轴方向的力矩 但在固定轴的场合 与这个力矩平衡的约束力生成式N的第1 2分量 不产生运动 由于机器人是具有分布质量的三维 多自由度机构 利用牛顿力学建模非常困难 拉格朗日力学成为主要的动力学分析方法 2020 4 19 12 4 3拉格朗日运动方程式 拉格朗日运动方程式仅仅包涵能量项对系统变量和时间的微分 结构简单 因此多数教科书利用该方程进行动力学推导 拉格朗日力学以两个方程为基础 一个是直线运动 另一个针对旋转运动 2020 4 19 13 4 3拉格朗日运动方程式 拉格朗日运动方程式可表示为 4 6 4 7 式中 q是广义坐标 是广义力 当为直线运动时 为力的单位 当为转动时 它为力矩的单位 拉格朗日运动方程式也可表示为 这里 L是拉格朗日算子 K是动能 P是势能 2020 4 19 14 4 3拉格朗日运动方程式 例 用拉格朗日运动方程式推导下图所示的单自由度系统力和加速度的关系 车轮的质量忽略不计 小车的动能为 拉格朗日算子为 小车系统的势能为 2020 4 19 15 4 3拉格朗日运动方程式 拉格朗日函数的导数为 因此小车系统的运动方程为 2020 4 19 16 4 3拉格朗日运动方程式 现就前面讲的1自由度机械手来具体求解 假定 为广义坐标 则有 由于 4 8 2020 4 19 17 4 3拉格朗日运动方程式 所以用 置换式 4 6 的广义坐标后得到下式 4 9 它与前面的结果完全一致 下面推导图4 5所示的2自由度机械手的运动方程式 在推导时 把 1 2当作广义坐标 1 2当作广义力求拉格朗日算子 代入式 4 6 即可得到 2020 4 19 18 4 3拉格朗日运动方程式 第1个连杆的动能K1 势能P1可分别表示为 4 10 2020 4 19 19 4 3拉格朗日运动方程式 式中 是第i个连杆质量中心的位置向量 4 11 2020 4 19 20 4 3拉格朗日运动方程式 应该注意到各连杆的动能可用质量中心平移运动的动能和绕质量中心回转运动的动能之和来表示 由式 4 11 得到式 4 10 中的质量中心速度平方和为 利用式 4 10 和式 4 12 4 13 通过下式 4 12 4 13 2020 4 19 21 4 3拉格朗日运动方程式 式中 可求出拉格朗日算子L 把它代入式 4 6 的拉格朗日运动方程式 整理后可得 2020 4 19 22 4 3拉格朗日运动方程式 4 37 2020 4 19 23 4 3拉格朗日运动方程式 是惯性力 是离心力 表示加在机械手上的重力项 g是重力加速度常数 对于多于3个自由度的机械手 也可用同样的方法推导出运动方程式 但随自由度的增多演算量将急剧增加 2020 4 19 24 4 4机械手动力学方程 在分析了二连杆机械手的基础上 我们分析由一组A变换描述的任何机械手 求其动力学方程 分以下5步进行推导 1 计算任一连杆上任一点的速度 2 计算各连杆的动能和机械手的总动能 3 计算各连杆的位能和机械手的总位能 4 建立机械手系统的拉格朗日函数 5 对拉格朗日函数求导 以得到动力学方程 2020 4 19 25 4 4机械手动力学方程 下图表示一个四连杆机械手的结构 我们先从这个例子出发 求得此机械手某个连杆 例如连杆3 上某一点 P 的速度 质点和机械手的动能与位能 拉格朗日算子 求系统的动力学方程 然后 由特殊到一般 导出任何机械手的速度 动能 位能和动力学方程的一般表达式 2020 4 19 26 4 4机械手动力学方程 2020 4 19 27 4 4 1速度的计算 图中连杆3上点P的位置为 式中 为基坐标系中的位置矢量 为局部 相对关节O3 坐标系中的位置矢量 T3为变换矩阵 包括旋转和平移变换 对于任一连杆i上的一点 其位置为 2020 4 19 28 4 4 1速度的计算 点P的速度为 4 14 2020 4 19 29 4 4 1速度的计算 对于连杆i上任一点的速度为 4 15 P点的加速度 2020 4 19 30 4 4 1速度的计算 速度的平方 对于任一机械手上一点的速度平方为 4 16 2020 4 19 31 4 4 2动能和位能的计算 令连杆3上任一质点P的质量为dm 则其动能为 任一机械手连杆i上位置矢量的质点 其动能为 2020 4 19 32 4 4 2动能和位能的计算 对连杆3积分dK3 得连杆3的动能为 式中 积分称为连杆的伪惯量矩阵 并记为 2020 4 19 33 4 4 2动能和位能的计算 任何机械手上任一连杆i的动能为 4 17 式中 Ii为伪惯量矩阵 其表达式为 2020 4 19 34 4 4 2动能和位能的计算 式中 Ii为伪惯量矩阵 其表达式为 2020 4 19 35 4 4 2动能和位能的计算 物体的转动惯量 矢量积以及一阶矩量为 如果令 2020 4 19 36 4 4 2动能和位能的计算 于是可把Ii表示为 4 18 2020 4 19 37 4 4 2动能和位能的计算 具有n个连杆的机械手总的动能为 4 19 连杆i的传动装置动能为 式中 Iai为传动装置的等效转动惯量 对于平动关节 Iai为等效质量 传动关节的传动装置总动能为 2020 4 19 38 4 4 2动能和位能的计算 下面计算机械手的位能 一个高度为h 质量为m的物体其位能为 P mgh 连杆i上位置处的质点dm 其位能为 2020 4 19 39 4 4 2动能和位能的计算 其中 mi为连杆I的质量 为连杆I相对于其前端关节坐标系的