第章-工业机器人静力计算及动力学分析
————————————————————————————————作者: ————————————————————————————————日期:
?
注：1）2008年春季讲课用；2）带下划线的黑体字为板书内容；3）公式及带波浪线的部分为必讲内容第3章工业机器人静力学及动力学分析 3.1 引言 在第2章中，我们只讨论了工业机器人的位移关系，还未涉及到力、速度、加速度。由理论力学的知识我们知道，动力学研究的是物体的运动和受力之间的关系。要对工业机器人进行合理的设计与性能分析，在使用中实现动态性能良好的实时控制，就需要对工业机器人的动力学进行分析。在本章中，我们将介绍工业机器人在实际作业中遇到的静力学和动力学问题，为以后“工业机器人控制”等章的学习打下一个基础。 在后面的叙述中，我们所说的力或力矩都是“广义的”，包括力和力矩。 工业机器人作业时，在工业机器人与环境之间存在着相互作用力。外界对手部（或末端操作器）的作用力将导致各关节产生相应的作用力。假定工业机器人各关节“锁住”，关节的“锁定用”力与外界环境施加给手部的作用力取得静力学平衡。工业机器人静力学就是分析手部上的作用力与各关节“锁定用”力之间的平衡关系，从而根据外界环境在手部上的作用力求出各关节的“锁定用”力，或者根据已知的关节驱动力求解出手部的输出力。 关节的驱动力与手部施加的力之间的关系是工业机器人操作臂力控制的基础，也是利用达朗贝尔原理解决工业机器人动力学问题的基础。 工业机器人动力学问题有两类：(1)动力学正问题——已知关节的驱动力，求工业机器人系统相应的运动参数，包括关节位移、速度和加速度。(2)动力学逆问题——已知运动轨迹点上的关节位移、速度和加速度，求出相应的关节力矩。 研究工业机器人动力学的目的是多方面的。动力学正问题对工业机器人运动仿真是非常有用的。动力学逆问题对实现工业机器人实时控制是相当有用的。利用动力学模型，实现最优控制，以期达到良好的动态性能和最优指标。 工业机器人动力学模型主要用于工业机器人的设计和离线编程。在设计中需根据连杆质量、运动学和动力学参数，传动机构特征和负载大小进行动态仿真，对其性能进行分析，从而决定工业机器人的结构参数和传动方案，验算设计方案的合理性和可行性。在离线编程时，为了估计工业机器人高速运动引起的动载荷和路径偏差，要进行路径控制仿真和动态模型的仿真。这些都必须以工业机器人动力学模型为基础。 工业机器人是一个非线性的复杂的动力学系统。动力学问题的求解比较困难，而且需要较长的运算时间。因此，简化求解过程，最大限度地减少工业机器人动力学在线计算的时间是一个受到关注的研究课题。 在这一章里，我们将首先讨论与工业机器人速度和静力学有关的雅可比矩阵，然后介绍工业机器人的静力学问题和动力学问题。
第3章 工业机器人静力计算及动力学分析 章节题目：第3章 工业机器人静力计算及动力学分析 [教学内容] 3.1 工业机器人速度雅可比与速度分析 3.2 工业机器人力雅可比与静力计算 3.3 工业机器人动力学分析 [教学安排] 第3章安排6学时，其中介绍工业机器人速度雅可比45分钟，工业机器人速度分析45分钟，操作臂中的静力30分钟，机器人力雅可比30分钟，机器人静力计算的两类问题10分钟，拉格朗日方程20分钟，二自由度平面关节机器人动力学方程60分钟，关节空间和操作空间动力学30分钟。 通过多媒体课件结合板书的方式，采用课堂讲授和课堂讨论相结合的方法，首先讨论与机器人速度和静力有关的雅可比矩阵，然后介绍工业机器人的静力学问题和动力学问题。 [知识点及其基本要求] 1、工业机器人速度雅可比（掌握） 2、速度分析（掌握） 3、操作臂中的静力（掌握） 4、机器人力雅可比（掌握） 5、机器人静力计算的两类问题（了解） 6、拉格朗日方程（熟悉） 7、二自由度平面关节机器人动力学方程（理解） 8、关节空间和操作空间动力学（了解） [重点和难点] 重点：1、速度雅可比及速度分析 2、力雅可比 3、拉格朗日方程 4、二自由度平面关节机器人动力学方程 难点：1、关节空间和操作空间动力学 [教学法设计] 引入新课： 至今我们对工业机器人运动学方程还只局限于静态位置问题的讨论，还没有涉及力、速度、加速度等。机器人是一个多刚体系统，像刚体静力学平衡一样，整个机器人系统在外载荷和关节驱动力矩（驱动力）作用下将取得静力平衡；也像刚体在外力作用下发生运动变化一样，整个机器人系统在关节驱动力矩（驱动力）作用下将发生运动变化。 新课讲解： 第一次课 第三章 工业机器人静力计算及动力学分析 3-1 工业机器人速度雅可比与速度分析 一、工业机器人速度雅可比 假设有六个函数，每个函数有六个变量，即： ??? ???? ===),,,,,(),,,,,(),,,,,(654321666543212265432111x x x x x x f y x x x x x x f y x x x x x x f y ，可写成Y=F(X)，
实验6 数据拟合及参数辨识方法 一、实验目的及意义 [1] 了解最小二乘拟合的基本原理和方法； [2] 掌握用MATLAB作最小二乘多项式拟合和曲线拟合的方法； [3] 通过实例学习如何用拟合方法解决实际问题，注意与插值方法的区别。 [4] 了解各种参数辨识的原理和方法； [5] 通过范例展现由机理分析确定模型结构，拟合方法辨识参数，误差分析等求解实 际问题的过程； 通过该实验的学习，掌握几种基本的参数辨识方法，了解拟合的几种典型应用，观察不同方法得出的模型的准确程度，学习参数的误差分析，进一步了解数学建模过程。这对于学生深入理解数学概念，掌握数学的思维方法，熟悉处理大量的工程计算问题的方法具有十分重要的意义。 二、实验内容 1．用MATLAB中的函数作一元函数的多项式拟合与曲线拟合，作出误差图； 2．用MATLAB中的函数作二元函数的最小二乘拟合，作出误差图； 3．针对预测和确定参数的实际问题，建立数学模型，并求解。 三、实验步骤 1．开启软件平台——MATLAB，开启MATLAB编辑窗口； 2．根据各种数值解法步骤编写M文件 3．保存文件并运行； 4．观察运行结果(数值或图形)； 5．根据观察到的结果写出实验报告，并浅谈学习心得体会。 四、实验要求与任务 根据实验内容和步骤，完成以下具体实验，要求写出实验报告（实验目的→问题→数学模型→算法与编程→计算结果→分析、检验和结论→心得体会） 应用实验 1．旧车价格预测 某年美国旧车价格的调查资料如下表，其中x i表示轿车的使用年数，y i表示相应的平均价格。试分析用什么形式的曲线来拟合上述的数据，并预测使用4.5年后轿车的平均价
二自由度机械臂动力 学分析
平面二自由度机械臂动力学分析 姓名：黄辉龙 专业年级：13级机电 单位：汕头大学 摘要：机器臂是一个非线性的复杂动力学系统。动力学问题的求解比较困难，而且需要较长的运算时间，因此，这里主要对平面二自由度机械臂进行动力学研究。拉格朗日方程在多刚体系统动力学的应用方法分析平面二自由度机械臂的正向动力学。经过分析，得出平面二自由度机械臂的动力学方程，为后续更深入研究做铺垫。 关键字：平面二自由度 动力学方程 拉格朗日方程 相关介绍 机器人动力学的研究有牛顿-欧拉（Newton-Euler ）法、拉格朗日 (Langrange)法、高斯（Gauss ）法等，但一般在构建机器人动力学方程中，多采用牛顿-欧拉法及拉格朗日法。 欧拉方程又称牛顿-欧拉方程，应用欧拉方程建立机器人机构的动力学方程是指研究构件质心的运动使用牛顿方程，研究相对于构件质心的转动使用欧拉方程，欧拉方程表征了力、力矩、惯性张量和加速度之间的关系。 在机器人的动力学研究中，主要应用拉格朗日方程建立机器人的动力学方程，这类方程可直接表示为系统控制输入的函数，若采用齐次坐标，递推的拉格朗日方程也可以建立比较方便且有效的动力学方程。 在求解机器人动力学方程过程中，其问题有两类： 1)给出已知轨迹点上? ??θθθ、及、 ，即机器人关节位置、速度和加速度，求相应的关节力矩矢量τ。这对实现机器人动态控制是相当有用的。 2)已知关节驱动力矩，求机器人系统相应各瞬时的运动。也就是说，给出关节力矩矢量τ，求机器人所产生的运动? ??θθθ、及、 。这对模拟机器人的运动是非常有用的。 平面二自由度机械臂动力学方程分析及推导过程 1、机器人是结构复杂的连杆系统，一般采用齐次变换的方法，用拉格朗日方程建立其系统动力学方程，对其位姿和运动状态进行描述。机器人动力学方程的具体推导过程如下： 1) 选取坐标系，选定完全而且独立的广义关节变量n r ,,2,1,r ???=θ。 2) 选定相应关节上的广义力r F ：当r θ是位移变量时，r F 为力；当r θ是角度变量时，r F 为力矩。 3)求出机器人各构件的动能和势能，构造拉格朗日函数。 4) 代入拉格朗日方程求得机器人系统的动力学方程。 2、下面以图1所示说明机器人二自由度机械臂动力学方程的推导过程。
机器人动力学研究的典型方法和应用 （燕山大学 机械工程学院） 摘 要：本文介绍了动力学分析的基础知识，总结了机器人动力学分析过程中比较常用的动力学分析的方法：牛顿—欧拉法、拉格朗日法、凯恩法、虚功原理法、微分几何原理法、旋量对偶数法、高斯方法等，并且介绍了各个方法的特点。并通过对PTl300型码垛机器人弹簧平衡机构动力学方法研究，详细分析了各个研究方法的优越性和方法的选择。 前 言：机器人动力学的目的是多方面的。机器人动力学主要是研究机器人机构的动力学。机器人机构包括机械结构和驱动装置，它是机器人的本体，也是机器人实现各种功能运动和操作任务的执行机构，同时也是机器人系统中被控制的对象。目前用计算机辅助方法建立和求解机器人机构的动力学模型是研究机器人动力学的主要方法。动力学研究的主要途径是建立和求解机器人的动力学模型。所谓动力学模指的是一组动力学方程（运动微分方程），把这样的模型作为研究力学和模拟运动的有效工具。 报告正文： （1）机器人动力学研究的方法 1）牛顿—欧拉法 应用牛顿—欧拉法来建立机器人机构的动力学方程，是指对质心的运动和转动分别用牛顿方程和欧拉方程。把机器人每个连杆（或称构件）看做一个刚体。如果已知连杆的表征质量分布和质心位置的惯量张量，那么，为了使连杆运动，必须使其加速或减速，这时所需的力和力矩是期望加速度和连杆质量及其分布的函数。牛顿—欧拉方程就表明力、力矩、惯性和加速度之间的相互关系。 若刚体的质量为m ，为使质心得到加速度a 所必须的作用在质心的力为F ，则按牛顿方程有：ma F = 为使刚体得到角速度ω、角加速度εω= 的转动，必须在刚体上作用一力矩M ， 则按欧拉方程有：εωI I M += 式中，F 、a 、M 、ω、ε都是三维矢量；I 为刚体相对于原点通过质心并与刚
机器人动力学参数辨识 专业：控制理论与控制工程姓名：徐勇军 学号：2010522091
一．引言 机器人系统是一个非线性、强耦合、时变的复杂系统。在现有机器人控制方法中，大多是基于模型的控制方法，如前馈补偿法、计算力矩法及自适应控制等，而是机器人动力学模型参数对机器人控制系统的性能有着很大的影响。但是如何获得准确的动力学模型参数是很难的，因为在机器人动力学方程中的各项系数)(),,(),(θθθθG H D ? 本质上是时变的、非线性和耦合的，因此要确定精确的系数值，只有对机器人的动力学参数进行辨识估计。 目前，常用的机器人动力学方程有Lagrange 方程、Gauss 原理、Newton-Euler 方程等等。本文从机器人动力学Lagrange 方程出发，导出一种适用于进行动力学参数辨识的机器人动力学方程的表述形式。 辨识方法的选择：目前，有很多成熟的方法可用于模型的参数辨识，如极大似然法、辅助变量法、随机逼近法和最小二乘法等。鉴于最小二乘法在参数辨识中对量测噪声及具有任意分布规律的干扰噪声都具有不变性；同时，考虑到该方程所获得的参数估计值有着最佳统计特性，在实用中亦具备多种通用算法与程序，故本文采用最小二乘法来解决机器人动力学参数的辨识问题。 二、机器人动力学 根据Lagrane_Euler 方程，机器人动力学模型可用一个二阶非线性微分方程来描述，其形式如下： )())(())(),(()())((t t q G t q t q C t q t q M τ=++? ?? （1） 式中，n R t ∈)(τ为输入量，表示施加在机器人各个关节上的力/力矩向量； n R t q t q t q ∈? ?? )(),(),(为输出量，分别代表机器人的位置、速度及加速度向量； n R t q M ∈))((是惯性矩阵；n R t q t q C ∈? ))(),((为哥式力与离心力向量；n R t q G ∈))((是
机器人课程复习 一、名词解释 工作空间：工业机器人执行任务时，其腕轴交点能在空间活动的范围 刚体自由度：物体能够对坐标系进行独立运动的数目 机器人的自由度：机器人末端构件所具有的独立运动的数目。 机器人工作载荷：机器人在规定的性能范围内，机械接口处能承受的最大负载量（包括手部）。 机器人运动学正、逆问题： 机器人正动力学问题已知机器人各关节驱动力或力矩，求机器人各关节轨迹或末端执行器（位姿）轨迹。 机器人逆动力学问题已知机器人各关节轨迹或末端执行器（位姿）轨迹，求机器人各关节驱动力或力矩。 雅可比矩阵：研究机器人操作空间速度与关节空间速度间的线性映射关系即雅克比矩阵 机器人运动学：从几何学的观点来处理手指位置与关节变量的关系称为运动学。机器人动力学：机器人各关节变量对时间的一阶导数、二阶导数与各执行器驱动力或力矩之间的关系，即机器人机械系统的运动方程。 PWM驱动：脉冲宽度调制（Pulse Width Modulation）驱动 直流伺服电机的调节特性：是指转矩恒定时，电动机的转速随控制电压变化的 关系。 直流伺服电机的调速精度：指调速装置或系统的给定角速度与带额定负载时的 实际角速度之差，与给定转速之比。 示教再现：一种可重复再现通过示教编程存储起来的作业程序的机器人。示教有直接示教和间接示教两种方法。直接示教是操作人员使用插入机器
人手臂内的操作杆，按给定运动顺序示教动作内容，机器人自动把顺 序、位置和时间等具体数值记录在存储器中。再现时，依次读出存储 的信息，重复示教的动作过程。间接示教是采用示教盒(或称示教器) 示教。操作者通过示教盒按键操纵完成空间作业轨迹点与其有关速度 等信息的示教，然后用操作盘对机器人语言命令进行用户工作程序的 编辑，并存储在示教数据区。再现时，机器人的计算机控制系统自动 逐条取出示教命令与位置数据，进行解读、运算并作出判断，将各种 控制信号送到相应的驱动系统或端口,使机器人忠实地再现示教动 作。 PID控制：指按照偏差的比例（P, proportional）、积分（I, integral）、微分（D, derivative）进行控制。 脱机编程：指用机器人程序语言预先进行程序设计，而不是用示教的方法编程。 二、填空题 1、机器人按机构特性可以划分为（关节机器人）和（非关节机器人）两大类。 2、机器人系统大致由（驱动系统）、（机械系统）、（感知系统）和（人机交互系统、机器-环境交互系统、控制系统等部分组成。 3、机器人的重复定位精度是指（机器人末端执行器为重复到达同一目标位置（理想位置）而实际到达位置之间的接近程度）。 4、齐次坐标[0 0 1 0]T表示的内容是 z方向。 5、机器人的运动学是研究机器人末端执行器位姿和运动与关节空间之间的关系。
总评成绩：《机器人应用技术》实验报告 专业：机电一体化 班级：机电141班 学号：140212107 姓名：刘宗成 河南工学院 机电工程系
实验一工业机器人机械结构 实验目的：1、认识机器人的基本结构和组成 2、熟悉工业机器人基本工作原理 3、了解工业机器人技术参数 实验原理： 六自由度机械手本体结构图 实验器材：1、FANUC M-6i六自由度机械手二台 2、FANUC M-6iB六自由度机械手一台 3、ABB IRB-2400六自由度机械手一台 4、实验设备使用说明书各一本 实验步骤：1、学习ABB和FANUC六自由度机械手基本构成控制柜与机械本体 2、学习六自由度机械手本体各关节的作用 3、学习六自由度机械手本体中定位关节与姿态关节 4、学习六自由度机械手本体各关节驱动机构与传动机构 5、学习典型工业机器人机械本体质量分布，以及各关节中质量平衡和力矩平衡 6、学习六自由度机械手各关节运动范围及运动速度控制 7、学习工业机器人重复定位精度的定义，并且了解相应机器人的重复定位精度 8、学习工业机器人最大负载 9、学习工业机器人最大运动范围 实验报告：课后每位同学按照要求完成实验报告。 思考题：1、画出六自由度机械手的结构简图 2、分析各关节机械手臂的运动范围 注意事项：1、实验开始之前认真学习工业机器人机械本体结构。 2、实验过程认真阅读实验设备说明书。
实验报告
实验二 机器人运动学实验 实验目的：1、了解四自由机械臂的开链结构 2、掌握机械臂运动关节之间的坐标变换原理 3、学会机器人运动方程的正反解方法 实验原理： 机器人运动学只涉及到物体的运动规律，不考虑产生运动的力和力矩。机器人正运动学所研究的内容是：给定机器人各关节的角度或位移，求解计算机器人末端执行器相对于参考坐标系的位置和姿态问题。 各连杆变换矩阵相乘，可得到机器人末端执行器的位姿方程（正运动学方程）为 ： 432140 A A A A T ==????? ???????10 00 z z z z y y y y x x x x p a o n p a o n p a o n 其中：z 向矢量处于手爪入物体的方向上，称之为接近矢量a ，y 向矢量的方向从一个 指尖指向另一个指尖，处于规定手爪方向上，称为方向矢量o ；最后一个矢量叫法线矢量n ， 它与矢量o 和矢量a 一起构成一个右手矢量集合，并由矢量的叉乘所规定：a o n ?=。 上式表示了机器人变换矩阵40T ，它描述了末端连杆坐标系{4}相对基坐标系{0}的位姿，是机械手运动分析和综合的基础。 实验器材： 1、RBT-4T03S 机器人一台； 2、RBT-4T03S 机器人控制柜一台； 3、装有运动控制卡和控制软件的计算机一台。 实验步骤： 1、 根据机器人坐标系的建立中得出的A 矩阵，相乘后得到T 矩阵，根据一一对应的关系，写出机器人正解的运算公式，并填入表6-1中； 表6-1机器人的正运动学的参数
平面二自由度机械臂动力学分析 [摘要] 机器臂是一个非线性的复杂动力学系统。动力学问题的求解比较困难，而且需要较长的运算时间，因此，这里主要对平面二自由度机械臂进行动力学研究。本文采用拉格朗日方程在多刚体系统动力学的应用方法分析平面二自由度机械臂的正向动力学。经过研究得出平面二自由度机械臂的动力学方程，为后续更深入研究做铺垫。 [关键字] 平面二自由度 一、介绍 机器人是一个非线性的复杂动力学系统。动力学问题的求解比较困难，而且需要较长的运算时间，因此，简化解的过程，最大限度地减少工业机器人动力学在线计算的时间是一个受到关注的研究课题。 机器人动力学问题有两类： (1) 给出已知的轨迹点上的，即机器人关节位置、速度和加速度，求相应的关节力矩向量Q r。这对实现机器人动态控制是相当有用的。 (2) 已知关节驱动力矩，求机器人系统相应的各瞬时的运动。也就是说，给出关节力矩向量τ，求机器人所产生的运动。这对模拟机器人的运动是非常有用的。 二、二自由度机器臂动力学方程的推导过程 机器人是结构复杂的连杆系统，一般采用齐次变换的方法，用拉格朗日方程建立其系统动力学方程，对其位姿和运动状态进行描述。机器人动力学方程的具体推导过程如下： (1) 选取坐标系，选定完全而且独立的广义关节变量θr ，r=1, 2,…, n。 (2) 选定相应关节上的广义力F r：当θr是位移变量时，F r为力；当θr是角度变量时， F r为力矩。 (3) 求出机器人各构件的动能和势能，构造拉格朗日函数。 (4) 代入拉格朗日方程求得机器人系统的动力学方程。 下面以图1所示说明机器人二自由度机械臂动力学方程的推导过程。
第六章机器人操作臂动力学 动力学研究的是物体的运动和受力之间的关系。操作臂动力学有两个问题需要解决。 ①动力学正问题：根据关节运动力矩或力，计算操作臂的运动（关节位移，速 度和加速度） ②动力学逆问题：已知轨迹运动对应的关节位移，速度和加速度，求出所需要 的关节力矩或力。 机器人操作臂是个复杂的动力学系统，由多个连杆和多个关节组成，具有多个输入和多个输出，存在着错综复杂的耦合关系和严重的非线性。因此，对于机器人动力学的研究，引起了十分广泛的重视。所采用的方法很多，①有拉格朗日方法，②牛顿-欧拉方法，③高斯法，④凯恩方法，⑤旋量对偶数方法等等。在此重点介绍牛顿-欧拉方法，它是基于运动坐标和达朗贝尔原理来建立相应的运动方程。 研究机器人动力学的目的是多方面的，动力学正问题与操作臂仿真有关，逆问题是为实时控制的需要，利用动力学模型，实现最优控制，以期达到良好的动态性能和最优指标。 机器人动力学模型主要用于机器人的设计和离线编程。在设计中需根据连杆质量，运动学和动力学参数，传动机构特征和负载大小进行动态仿真，从而决定机器人的结构参数和传动方案，验算设计方案的合理性和可行性，以及结构优化程度。在离线编程时，为了估计机器人高速运动引起的动载荷和路径偏差，要进行路径控制仿真和动态模型的仿真。这些都必须以机器人动态模型为基础。 为了建立机器人动力学方程，在此首先讨论机器人运动的瞬时状态，对其进行速度分析和加速度分析，研究连杆的静力平衡，然后利用朗贝尔原理，将静力学平衡条件用于动力学。 §6-1连杆的速度和加速度 点的速度表示一般要涉及到两个坐标系： 要指明速度是相对于哪个坐标系的运动所造成的。
第3章工业机器人静力计算及动力学分析 章节题目：第3章工业机器人静力计算及动力学分析 [教学内容] 3.1 工业机器人速度雅可比与速度分析 3.2 工业机器人力雅可比与静力计算 3.3 工业机器人动力学分析 [教学安排] 第3章安排6学时，其中介绍工业机器人速度雅可比45分钟，工业机器人速度分析45分钟，操作臂中的静力30分钟，机器人力雅可比30分钟，机器人静力计算的两类问题10分钟，拉格朗日方程20分钟，二自由度平面关节机器人动力学方程60分钟，关节空间和操作空间动力学30分钟。 通过多媒体课件结合板书的方式，采用课堂讲授和课堂讨论相结合的方法，首先讨论与机器人速度和静力有关的雅可比矩阵，然后介绍工业机器人的静力学问题和动力学问题。 [知识点及其基本要求] 1、工业机器人速度雅可比（掌握） 2、速度分析（掌握） 3、操作臂中的静力（掌握） 4、机器人力雅可比（掌握） 5、机器人静力计算的两类问题（了解） 6、拉格朗日方程（熟悉） 7、二自由度平面关节机器人动力学方程（理解） 8、关节空间和操作空间动力学（了解） [重点和难点] 重点：1、速度雅可比及速度分析 2、力雅可比
3、拉格朗日方程 4、二自由度平面关节机器人动力学方程 难点：1、关节空间和操作空间动力学 [教学法设计] 引入新课： 至今我们对工业机器人运动学方程还只局限于静态位置问题的讨论，还没有涉及力、速度、加速度等。机器人是一个多刚体系统，像刚体静力学平衡一样，整个机器人系统在外载荷和关节驱动力矩（驱动力）作用下将取得静力平衡；也像刚体在外力作用下发生运动变化一样，整个机器人系统在关节驱动力矩（驱动力）作用下将发生运动变化。 新课讲解： 第一次课 第三章工业机器人静力计算及动力学分析 3-1 工业机器人速度雅可比与速度分析 一、工业机器人速度雅可比 假设有六个函数，每个函数有六个变量，即：，可写成 Y=F(X，将其微分，得：，也可简写成 。该式中（6×6）矩阵叫做雅可比矩阵。 在工业机器人速度分析和以后的静力分析中都将遇到类似的矩阵，称之为机器人雅可比矩阵，或简称雅可比矩阵。 二自由度平面关节机器人，端点位置x，y与关节θ1、θ2的关系为：
第六章 机器人运动学及动力学 6.1 引论 到现在为止我们对操作机的研究集中在仅考虑动力学上。我们研究了静力位置、静力和速度，但我们从未考虑过产生运动所需的力。本章中我们考虑操作机的运动方程式——由于促动器所施加的扭矩或作用在机械手上的外力所产生的操作机的运动之情况。 机构动力学是一个已经写出很多专著的领域。的确，人们可以花费以年计的时间来研究这个领域。显然，我们不可能包括它所应有的完整的内容。但是，某种动力学问题的方程式似乎特别适合于操作机的应用。特别是，那种能利用操作机的串联链性质的方法是我们研究的天然候选者。 有两个与操作机动力学有关的问题我们打算去解决。向前的动力学问题是计算在施加一 组关节扭矩时机构将怎样运动。也就是，已知扭矩矢量τ，计算产生的操作机的运动Θ、Θ 和Θ 。这个对操作机仿真有用，在逆运动学问题中，我们已知轨迹点Θ、Θ 和Θ ，我们欲求出所需要的关节扭矩矢量τ。这种形式的动力学对操作机的控制问题有用。 6.2 刚体的加速度 现在我们把对刚体运动的分析推广到加速度的情况。在任一瞬时，线速度矢量和角速度矢量的导数分别称为线加速度和角加速度。即 B B Q Q B B Q Q 0V ()V ()d V V lim dt t t t t t ?→+?-==? （6-1） 和 A A Q Q A A Q Q 0()()d lim dt t t t t t ?→Ω+?-ΩΩ=Ω=? （6-2） 正如速度的情况一样，当求导的参坐标架被理解为某个宇宙标架{}U 时我们将用下面的记号 U A AORG V V = （6-3） 和 U A A ω=Ω （6-4）
6.2.1 线加速度 我们从描述当原点重合时从坐标架{}A 看到的矢量B Q 的速度 A A B A A Q B Q B B V V B R R Q =+Ω? （6-5） 这个方程的左手边描述A Q 如何随时间而变化。所以，因为原点是重合的，我们可以重写（6-5）为 A A B A A B B Q B B d ()V dt B B R Q R R Q =+Ω? （6-6） 这种形式的方程式当推导对应的加速度方程时特别有用。 通过对（6-5）求导，我们可以推出当{}A 与{}B 的原点重合时从{}A 中看到的B Q 的 加速度表达式 A A B A A A A Q B Q B B B B d d V (V )()dt dt B B R R Q R Q =+Ω?+Ω? （6-7） 现在用（6-6）两次── 一次对第一项，一次对最后一项。（6-7）式的右侧成为： A B A A A A B Q B B Q B B A A A A B B Q B B V () +Ω?+Ω?+Ω?+Ω? B B B B R R V R Q R V R Q （6-8） 把相同两项合起来 A B A A A A B Q B B Q B B A A A B B B V 2 () +Ω?+Ω?+Ω?Ω? B B B R R V R Q R Q （6-9） 最后，为了推广到原点不重合的情况，我们加上一项给出{}B 的原点的线加速度的项，得到下面的最后的一般公式 A B A A A A BORG B Q B B Q B B A A A B B B V 2 () ++Ω?+Ω?+Ω?Ω? A B B B V R R V R Q R Q （6-10） 对于我们将在本章上考虑的情况，我们总是有B Q 为不变，或 B Q Q V 0== B V （6-11） 所以，（6-10）简化为 A A A A A A Q BORG B B B B B V ()=+Ω?Ω?+Ω? A B B V R Q R Q （6-12） 我们将用这一结果来计算操作机杆件的线加速度。 6.2.2 角加速度 考虑{}B 以A B Ω相对于{}A 转动的情况，而{}C 以B C Ω相对于{}B 转动。为了计算 A C Ω我们把矢量在坐标架{}A 中相加
第 3 章工业机器人静力计算及动力学分析 章节题目：第 3 章工业机器人静力计算及动力学分析 [教学内容 ] 3.1工业机器人速度雅可比与速度分析 3.2工业机器人力雅可比与静力计算 3.3工业机器人动力学分析 [教学安排 ] 第 3 章安排 6 学时，其中介绍工业机器人速度雅可比45 分钟，工业机器人速度分析45分钟，操作臂中的静力30 分钟，机器人力雅可比30 分钟，机器人静力计算的两类问题10分钟，拉格朗日方程20 分钟，二自由度平面关节机器人动力学方程60 分钟，关节空间和操作空间动力学30 分钟。 通过多媒体课件结合板书的方式，采用课堂讲授和课堂讨论相结合的方法，首先讨论与机器人速度和静力有关的雅可比矩阵，然后介绍工业机器人的静力学问题和动力学问题。 [知识点及其基本要求] 1、工业机器人速度雅可比（掌握） 2、速度分析（掌握） 3、操作臂中的静力（掌握） 4、机器人力雅可比（掌握） 5、机器人静力计算的两类问题（了解） 6、拉格朗日方程（熟悉） 7、二自由度平面关节机器人动力学方程（理解） 8、关节空间和操作空间动力学（了解） [重点和难点 ] 重点： 1、速度雅可比及速度分析 2、力雅可比 3、拉格朗日方程 4、二自由度平面关节机器人动力学方程 难点： 1、关节空间和操作空间动力学 [教学法设计 ] 引入新课： 至今我们对工业机器人运动学方程还只局限于静态位置问题的讨论，还没有涉及力、速度、加速度等。机器人是一个多刚体系统，像刚体静力学平衡一样，整个机器人系统在外载 荷和关节驱动力矩（驱动力）作用下将取得静力平衡；也像刚体在外力作用下发生运动变化 一样，整个机器人系统在关节驱动力矩（驱动力）作用下将发生运动变化。 新课讲解： 第一次课 第三章工业机器人静力计算及动力学分析 3-1 工业机器人速度雅可比与速度分析 一、工业机器人速度雅可比 y1 f 1 (x1 , x2 , x3 , x4 , x5 , x6 ) 假设有六个函数，每个函数有六个变量，即：y 2f2 ( x1 , x2 , x3 , x4 , x5 , x6 )，可写成 Y=F(X) ， y6f6 (x1 , x2 , x3 , x4 , x5 , x6 )