第八讲-机器人动力学-牛顿-欧拉方程

山东大学机械工程学院机电工程研究所2010/09/023.6小节机器人的杆件的速度山东大学机械工程学院机电工程研究所2010/09/023.6机器人的杆件的速度基本思路：

已知基座速度和各关节的相对速度，从基座速度开始，一步一步递推出末端执行器的速度。山东大学机械工程学院机电工程研究所2010/09/023.4.3、机器人的杆件的速度

机器人杆件的速度包括线速度和角速度，下面介绍如何从i杆件的速度递推计算i+1杆件的线速度和角速度。如图所示，设已知i杆件的速度为ωi和vi，i+1杆件绕Zi+1轴旋转的角速度为。

山东大学机械工程学院机电工程研究所2010/09/023.4.3、机器人的杆件的速度

则：在{i+1}坐标系中表示的i+1杆件杆的角速度为：

在{i+1}坐标系中表示的i+1坐标系原点的线速度为：在{i+1}中表示的i+1杆的角速度其中是在{i}中表示的指向{i+1}原点的距离。山东大学机械工程学院机电工程研究所2010/09/023.4.3、机器人的杆件的速度例1、一两杆关节机器人如图所示，计算以关节速度为函数的手尖处的速度。山东大学机械工程学院机电工程研究所2010/09/023.4.3、机器人的杆件的速度解：1、建立坐标系，如图：

2、求位姿矩阵：山东大学机械工程学院机电工程研究所2010/09/023.4.3、机器人的杆件的速度得：1杆在{1}中表示的速度山东大学机械工程学院机电工程研究所2010/09/023.4.3、机器人的杆件的速度如果在基座坐标系中表示，仅需乘以R03。则：山东大学机械工程学院机电工程研究所2010/09/023.4.3、机器人的杆件的速度例2、试求例1中两杆关节机器人的雅克比矩阵。解：由例1知：则：及山东大学机械工程学院机电工程研究所2010/09/023.4.3、机器人的杆件的速度

雅克比矩阵的行数等于笛卡尔空间自由度，列数等于机器人的关节数。同理，我们可以求相对基座坐标系的雅克比矩阵。所以：10山东大学机械工程学院机电工程研究所2010/09/023.4.3、机器人的杆件的速度

雅克比矩阵的逆为：

当手尖沿X方向以速度1m/s运动时，由雅克比逆矩阵可得：

当θ2=0时，上式分母为零，两关节速度将趋于无穷大，它对应机器人的奇异位置。山东大学机械工程学院机电工程研究所2010/09/02第4章机器人操作动力学4.1、概述4.2、机器人的牛顿-欧拉动力学方程4.3、机器人拉格朗日动力学方程简介山东大学机械工程学院机电工程研究所2010/09/024.1、概述为什么要研究机器人的动力学问题？

1、为了运动杆件，我们必须加速或减速它们，机器人的运动是作用于关节上的力矩与其他力或力矩作用的结果。

2、力或力矩的作用将影响机器人的动态性能。山东大学机械工程学院机电工程研究所2010/09/024.1、概述机器人动力学研究内容：正问题：已知作用在机器人机构上的力和力矩，求机器人机构各关节的位移、速度、加速度，即：F=ma。反问题：已知机器人机构各关节的位移、速度和加速度，求作用在各关节上的驱动力或驱动力矩，即：am=F。山东大学机械工程学院机电工程研究所2010/09/024.1、概述机器人动力学研究方法：目标：根据机器人机构的结构特点、运动学和动力学原理，提出通用、快捷的建立动力学方程的方法。数学工具：矢量方法、张量方法、旋量方法及矩阵方法等。力学原理：动量矩定理、能量守恒定理、牛顿－欧拉方程、达朗贝尔原理、虚功原理、拉格朗日方程、哈密尔顿原理、凯恩方程等。山东大学机械工程学院机电工程研究所2010/09/024.1、概述几项假设：

1、构成机器人的各杆件都是刚体，即不考虑杆件的变形。

2、忽略各种间隙等因数的影响。

3、暂不考虑驱动系统的动力学。15山东大学机械工程学院机电工程研究所2010/09/024.2机械人的牛顿—欧拉方程

机器人动力学的特点：

1、串联机器人由多个杆件经关节轴串联构成，属于多体动力学的研究范畴。

2、各杆件的速度、加速度是关节位置及时间的函数，随机器人杆件构形的不同而改变。

3、机器人动力学的计算复杂，多采用数值递推的方法计算。山东大学机械工程学院机电工程研究所2010/09/024.2机械人的牛顿—欧拉方程我们知道：刚体运动

=质心的平动+绕质心的转动其中：质心平动：用牛顿方程描述。绕质心的转动：用欧拉方程定义。它们都涉及到质量及其分布，我们先复习一下转动惯量的计算。山东大学机械工程学院机电工程研究所2010/09/024.2机械人的牛顿—欧拉方程

如图所示，设刚体的质量为，以质心为原点的随体坐标系下的惯量矩阵由六个量组成，表示为：一、惯量矩阵（张量）图3.1式中：山东大学机械工程学院机电工程研究所2010/09/024.2机械人的牛顿—欧拉方程

惯量矩阵中的元素称为惯量矩(Massmomentsofinertia)，而具有混合指标的元素称为惯量积(Massproductsofinertia)。对于给定的物体，惯量积的值与建立的坐标系的位置及方向有关；如果我们选择的坐标系合适，可使惯量积的值为零。这样的坐标系轴称为主轴（Principleaxes）,相应的惯量称为主惯量。事实上，主惯量是惯量矩阵的三个特征值。山东大学机械工程学院机电工程研究所2010/09/024.2机械人的牛顿—欧拉方程平行轴定理（Parallel-axistheorem）:

已知相对于某一原点位于物体质心坐标系{C}的惯量张量，坐标系{A}平行于坐标系{C}，则相对于{A}坐标系的惯量张量为：其中：为质心相对于{A}坐标系的坐标。20山东大学机械工程学院机电工程研究所2010/09/024.2机械人的牛顿—欧拉方程二、牛顿—欧拉方程我们假设机器人的每个杆件都为刚体，为了运动杆件，我们必须加速或减速它们，运动杆件所需要的力或力矩是所需加速度和杆件质量分布的函数；牛顿方程和用于转动情况的欧拉方程一起，描述了机器人驱动力矩、负载力（力矩）、惯量和加速度之间的关系。山东大学机械工程学院机电工程研究所2010/09/024.2机械人的牛顿—欧拉方程

我们先研究质心的平动，如图4.1所示，假设刚体的质量为，质心在C点，质心处的位置矢量用表示，则质心处的加速度为；设刚体绕质心转动的角速度用表示，绕质心的角加速度为，根据牛顿方程可得作用在刚体质心C处的力为：图4.1山东大学机械工程学院机电工程研究所2010/09/024.2机械人的牛顿—欧拉方程

根据三维空间欧拉方程，作用在刚体上的力矩为：

图4.1

以上两式合称为牛顿—欧拉方程。式中，M为作用力对刚体质心的矩，为绕质心的角速度和角加速度。山东大学机械工程学院机电工程研究所2010/09/024.2机械人的牛顿—欧拉方程三、加速度计算1、线加速度

如图所示，设坐标系i与i-1杆固联，其原点加速度为ai-1,角速度为ωi-1;Oi+1随杆件i相对i坐标系旋转，相对转速为

。P为i杆上任意一点。15山东大学机械工程学院机电工程研究所2010/09/024.2机械人的牛顿—欧拉方程Pi点的相对速度和加速度为：

Pi点的绝对加速度为：erk代入并化简得：即：上述参数都是在基础坐标系中表示的。26山东大学机械工程学院机电工程研究所2010/09/024.2机械人的牛顿—欧拉方程i+1坐标系原点的加速度为：设i杆件质心为ci,则其加速度为：2、角加速度

i杆的角加速度为：山东大学机械工程学院机电工程研究所2010/09/024.2机械人的牛顿—欧拉方程四、作用力和力矩

计算出每个杆件质心的加速度后，我们可以应用牛顿-欧拉方程来计算作用在每个杆件质心的惯性力和惯性力矩。根据牛顿-欧拉方程，有：28山东大学机械工程学院机电工程研究所2010/09/024.2机械人的牛顿—欧拉方程图2构件受力图

如图2所示，将第i个构件Li作为隔离体进行分析，作用在其上的力和力矩有：

作用在i杆件上的外力和外力矩，i-1杆件作用在i杆件上的力和力矩，以及i+1杆件作用在i杆件上的力和力矩。29山东大学机械工程学院机电工程研究所2010/09/023.3.1机械臂的牛顿—欧拉方程其中：

Fi+1,i—构件Li+1作用在构件Li上的力。Mi+1,i—构件Li+1作用在构件Li上的力矩。Fi-1,i—构件Li-1作用在构件Li上的力。Mi-1,i—构件Li-1作用在构件Li上的力矩。Fi—作用在第i个构件Li上的外力简化到质心C处的合力，即外力的主矢。Mi—作用在第i个构件Li上的外力矩简化到质心C处的合力矩，即外力的主矩。山东大学机械工程学院机电工程研究所2010/09/023.3.1机械臂的牛顿—欧拉方程

上述力和力矩包括了运动副中的约束反力、驱动力、摩擦力等引起的作用力和作用力矩。作用在第i个构件上的所有力化简到质心的总的合力为：它们都在基础坐标系中表示。山东大学机械工程学院机电工程研究所2010/09/023.3.1机械臂的牛顿—欧拉方程相对于质心的总的合力矩Mi为：

最后，为了便于递推计算，重新安排力和力矩计算公式为：山东大学机械工程学院机电工程研究所2010/09/023.3.1机械臂的牛顿—欧拉方程

i杆件需要的关节力矩为相邻杆件作用于它的力矩的Z分量，即：牛顿-欧拉方程的递推算法：由两部分组成：首先，从1号杆到n号杆，向前递推计算各杆的速度和加速度。然后，再从n号杆到1号杆，向后递推计算作用力和力矩，以及关节驱动力矩。算法过程总结如下：山东大学机械工程学院机电工程研究所2010/09/023.3.1机械臂的牛顿—欧拉方程向前递推：i:0→6向后递推：i:6→1惯性力惯性力矩条件：基础杆件和各关节的角速度和角加速度已知山东大学机械工程学院机电工程研究所2010/09/023.3.1机械臂的牛顿—欧拉方程

引力对杆件作用的影响可以通过设置来实现，这里，G为引力常数。上面给出了关节型机器人的动力学计算方法，对于移动关节可以推导相应的方程。对一些相对简单的问题，用上述方法，也可能得到闭式解析结果。上述递推算法是一种通用算法，可以用于任意自由度数的关节型机器人。山东大学机械工程学院机电工程研究所2010/09/02牛顿—欧拉方程实例图3平面两自由度机器人机构例1如图3所示的平面两自由度机器人机构。连杆L1质心为C1，质量为m1，驱动力矩为m1=[00m11]T，角速度为ω1=[00ω1]T,加速度为ε1=[00ε1]T;连杆L2质心为C2，质量为m2，驱动力矩为m2=[00m22]T，角速度为ω2=[00ω2]T,加速度为ε2=[00ε2]T，山东大学机械工程学院机电工程研究所2010/09/02牛顿—欧拉方程实例

选取关节O和关节A处的转角θ1和θ2为系统的广义坐标，可以写出连杆L1的牛顿—欧拉方程为:连杆L2的牛顿—欧拉方程为:式中:重力驱动力矩山东大学机械工程学院机电工程研究所2010/09/02牛顿—欧拉方程实例由以上几式消去杆件间作用力，可解得:考虑质心位置：求导得：山东大学机械工程学院机电工程研究所2010/09/02牛顿—欧拉方程实例另外：山东大学机械工程学院机电工程研究所2010/09/02牛顿—欧拉方程实例有：即：对m22可同样写出矩阵方程。代入加速度分量，得：山东大学机械工程学院机电工程研究所2010/09/02牛顿—欧拉方程实例化简可得：

上式即为各杆件关节的驱动力计算公式，它是一个以角加速度为变量、变系数的非线性动力学方程。山东大学机械工程学院机电工程研究所2010/09/02牛顿—欧拉方程实例以上两式进一步写成：式中：

系数是位置的函数山东大学机械工程学院机电工程研究所2010/09/02牛顿—欧拉方程实例

例2：如图所示为两杆平面机器人，为了简单起见，我们假设每个杆件的质量集中于杆件的尾部，其大小为m1和m2。解：每个杆件的质量中心矢量为：

由于点质量假设，每个杆件相对质心的惯性张量为零，即：山东大学机械工程学院机电工程研究所2010/09/02牛顿—欧拉方程实例末端执行器上无作用力，所以：基座静止，因此：考虑到引力，我们使用：山东大学机械工程学院机电工程研究所2010/09/02牛顿—欧拉方程实例应用递推公式有：向前：1杆件：山东大学机械工程学院机电工程研究所2010/09/02牛顿—欧拉方程实例2杆件：山东大学机械工程学院机电工程研究所2010/09/02牛顿—欧拉方程实例山东大学机械工程学院机电工程研究所2010/09/02牛顿—欧拉方程实例向后递推：2杆件：1杆件：山东大学机械工程学院机电工程研究所2010/09/02牛顿—欧拉方程实例取力矩的Z分量，得到关节力矩：山东大学机械工程学院机电工程研究所2010/09/02称为惯量阵，是离心力、科氏力等相关部分，为重力部分。特点：多变量、时变、非线性、强耦合。机器人机构动力学方程

通常，机器人的动力学方程常写为抽象的形式：其中：为广义坐标向量，为广义力向量。山东大学机械工程学院机电工程研究所2010/09/024.3机器人拉格朗日动力学方程简介

拉格朗日方程是基于能量项对系统变量及时间的微分而建立的。对于简单系统拉格朗日方程法相较于牛顿—欧拉方程法更显复杂，然而随着系统复杂程度的增加，拉格朗日方程法建立系统运动微分方程变得相对简单。山东大学机械工程学院机电工程研究所2010/09/02—拉格朗日函数为系统的动能和位能之差即：4.3机器人拉格朗日动力学方程简介系统拉格朗日方程为：

式中：

——系统的广义坐标数——作用在第i个广义坐标上的广义力或广义力矩——第i个广义坐标——第i个广义速度山东大学机械工程学院机电工程研究所2010/09/024.3机器人拉格朗日动力学方程简介步骤：

1、速度分析，求出速度的平方。

山东大学机械工程学院机电工程研究所2010/09/024.3机器人拉格朗日动力学方程简介2、求系统动能3、求系统位能山东大学机械工程学院机电工程研究所2010/09/024.3机器人拉格朗日动力学方程简介4、计算拉格朗日函数山东大学机械工程学院机电工程研究所2010/09/024.3机器人拉格朗日动力学方程简介5、代入拉格朗日方程山东大学机械工程学院机电工程研究所2010/09/024.3机器人拉格朗日动力学方程简介作用在关节上的广义力为：山东大学机械工程学院机电工程研究所2010/09/024.3机器人拉格朗日动力学方程简介上式进一步写成式中附录资料：不需要的可以自行删除防晒霜生产工艺配方油相

A

硬脂酸5％十八醇2.5％棕榈酸异丙酯1.5％凡士林5％防腐剂适量B石蜡油6％硅油Gy-2603.5％防晒剂POS-21％VE适量ME-40适量水相A钛白粉3.5％丙二醇3％B三乙醇胺1％二氧化钛其透过率小于氧化锌。对紫外线有散射作用,能减小紫外线对人体皮肤的幅射。覆盖力优良,增白皮肤。但涂抹性与透气性均差。加入量大于等于５％时,增白色泽不自然,固选用百分3.5。丙二醇丙二醇在化妆品中作湿润剂、保湿剂。三乙醇胺三乙醇胺在化妆品中还具有中和剂的作用，从而达到增稠和保湿的作用。硬脂酸

硬脂酸用于护肤品中起乳化作用，从而使其变成稳定洁白的膏体。十八醇化妆品中作为基质原料中的乳化剂、增稠剂应用棕榈酸异丙酯具有优良的保湿和滋润皮肤作用。皮肤对本品的吸收性很好，能在皮层内与毛囊有效接触，渗入皮层深处，并将化妆品中的活性组分带入，充分发挥有效成分的作用。作为化妆品溶剂及皮肤保湿剂、渗透剂。凡士林凡士林作为一种传统的化妆品原料,它在皮肤角质层表面形成一种隔离膜,具有防止皮肤表面水份减少的作用,保护皮肤免受外界剌激。因而它是一种极好的保温剂和护肤品。它对皮肤无剌激,无过敏。石蜡油石蜡油又称矿物油，由于矿物油具有低致敏性及不错的封闭性，有阻隔皮肤的水分蒸发的作用，所以常在乳液或乳霜中等护肤品种常被当作顺滑保湿剂来使用。硅油Gy-260硅油可提高膏体的透气性、亮度、涂抹性。ＧＹ一２６０比２０１硅油更理想。与基质配伍性比２０１硅油强。能在膏体表面形成极薄的膜,且不易腐败,因而可适量减少防腐剂用量。并能有助于防晒性的提高。防晒剂POS-2能有效阻挡UVA和UVB。VE维生素E本身是一种很好的抗氧化剂，它可以进入皮肤细胞具有抗自由基链式反应。从理论上优于氧化物歧化酶（SOD），在皮肤应用于预防角质化。vE是保护皮肤不受紫外线损伤和减少皮肤水份损失的活性组分”。ME一40能否得到稳定细腻的膏体,乳化剂是关键,只依靠自生皂化的乳化力是不够的。ME一40(C11H23O2)其用量在0.4一.7%就能得到极好的乳化效果,对膏体色泽无影响。工艺溶解A料溶解B料70-75℃水相升温升温油相加B料80-90℃保温灭菌20分钟降温75℃75℃搅拌加三乙醇胺65℃50-55℃加A料乳化（75±2℃）搅拌30分钟冷却50℃加香精搅匀冷却40℃搅匀出膏静置24H包装出库膏体研磨机均值搅拌机乳化机化妆品反应釜剂型与包装防晒霜为涂抹化妆品即我们采取的剂型为取乳状液物质。防晒霜的包装材质 材质PE（聚乙烯） 壁厚 0.40（mm）尺寸60-160（mm） 适用范围 管径30-50mm包装类型 化妆品软管附录资料：不需要的可以自行删除防晒霜生产工艺配方油相

A

硬脂酸5％十八醇2.5％棕榈酸异丙酯1.5％凡士林5％防腐剂适量B石蜡油6％硅油Gy-2603.5％防晒剂POS-21％VE适量ME-40适量水相A钛白粉3.5％丙二醇3％B三乙醇胺1％二氧化钛其透过率小于氧化锌。对紫外线有散射作用,能减小紫外线对人体皮肤的幅射。覆盖力优良,增白皮肤。但涂抹性与透气性均差。加入量大于等于５％时,增白色泽不自然,固选用百分3.5。丙二醇