6e6ff6818461f263342ec8c6cf5475e8.png

第四章使用牛顿欧拉法对动力学进行分析,更加直观地理解机器人运动原理,但是太复杂,因此本文介绍第二种动力学分析的方法——拉格朗日方法。拉格朗日方程在分析力学有着十分重要的地位。在分析之前,我们需要知道什么是拉格朗日方程,它是怎么来的。

第1小节 拉格朗日方程的由来

在经典力学中我们知道若要知道物体的运动,需要选取牛顿第一定律成立的惯性参考系,然后对物体利用牛顿第二定律列写微分方程组,若要解这个微分方程组,需要添加相应的约束。说白了,就是建立质点系平衡条件。那我们能不能进一步的推导,将约束条件与微分方程放在同一个公式中?建立一个与牛顿体系不同的平衡条件呢?事情的开始是从达朗贝尔原理说起。

质点的达朗贝尔原理:作用在质点上的主动力、约束力与虚加的惯性力在形式上组成平衡力。

质点系的达朗贝尔原理:质点系中每个质点上作用的主动力、约束力与惯性力在形式上组成平衡力系。

说的通俗一点就是将惯性引起的力也要受力分析,但这个力并不是真正意义上的力,只是在形式上可以看作力。

接下来再介绍虚位移原理,介绍之前先解释一下虚位移:在给定位置上质点或质点系在约束所容许的条件下可能发生的任何无限小位移,称为质点或质点系的虚位移。

这个概念中有几处不好理解的地方:

(1)约束所容许的条件:不能破坏系统约束的条件。

(2)可能发生:这个是假象的,与时间无关

(3)无限小:即不改变系统的状态(位置、速度、加速度等其他物理量)。

虚位移原理:具有双面、稳定、理想约束的质点系,在给定位置平衡的必要与充分条件是:所有作用于质点系的主动力在质点的任何虚位移中的虚功之和等于零。对于任意的物理系统,所有惯性力或施加的外力,经过符合约束条件的虚位移,所作的虚功的总合为零。

a149c2284a82ad4a803a24c0cbc7ded7.png

现假设一粒子

的位置
为广义坐标
的函数,即

f661d35121ad65b3b656014b9b7a1921.png

所受外力为

,其虚位移为

871c777617c41fab994e4d5bd31b3db5.png

带入虚位移原理的公式中

01cf7e2d6af3c8c290ab9f992d6087d2.png
公式1

bef8826383b872e0c2a919f3f9009394.png

则公式1变为

8fd7085986644b286aa7cf280813fd97.png
公式2

由于

cca9ca3640272430e11e54b9ab5d78cc.png

7124a01a14d521709a430ce735d6b1d2.png

因为

807b5ed422d4595eeb458f0f1b84296c.png

因此

c6dd48226c38ade603d75acd557591ef.png

又因为

093bb6bf44495a558508797b0dfa7789.png

因此

4c12ec215e071bab6b1628eedda03bb2.png

2401208c53ff1e98aa3f9ed9eb89bad9.png

8889ee61db6cefc1bf5efa9a9dc739a7.png

因此

52a16b7983a857cc482a0929fe778bf2.png

然后带入公式2中得

54c6d7ea0f228e2d9c1bb7a80779f810.png

因此

3383f29d8743b9e646a261881a21dd10.png

这就是基本形式的拉格朗日方程,又叫做第二类拉格朗日方程。

为保证正确,拉格朗日方程我又自己从头到尾推导了一遍,实在太消耗精力了,请各位小伙伴不要急躁,若有错误或不明白的地方,请各位小伙伴们在评论区写出来。

第2小节 拉格朗日方法对机器人进行动力学分析

牛顿方法分析动力学时在分析的过程中可以知道所有连杆生成运动的方向以及大小,虽然这个是优点,但缺点也显而易见,分析太过复杂,若系统复杂,出错的机会就会大大提高;而拉格朗日方法分析动力学是以能量的角度来看待系统的,但两者分析的结果却是相同的。

对于连杆而言,其动能包含连杆质心的动能以及绕质心旋转的动能两部分,即

ae00c5e95c0666573531a5a57c1eb050.png

上面的公式是一个连杆的动能,所有连杆的动能为

a459f3ac39b7e6cba6afbd2747416b99.png

这个动能是一个关于角度与角速度的函数,如果表示成矩阵的话,如下公式(其中的M是质量矩阵)

5c07014c87fe6a59379d5934c23aef53.png

除了动能外还需要考虑势能,第i连杆的势能表示为,

9ea4270c64bbb1c58c538b62847f2163.png

其中后面一个参数可以看作是重力的校正,这一项对后续的计算是没有影响的,和动能是相似的,所有杆件的总的势能表示为

c036bf927f6daf3978750191303a3752.png

但是这个总的势能只和关节变量有关,即

38b79007724b215c0d106be4ee80ef27.png

根据动能与势能的表达式,可以获得T的表达式,即

e06bc790ed31b748d573dbecca547548.png

则机器人的运动方程为

b0d6e5c74e547985d6647efbfee15e6a.png

题外话:终于毕业了,今年真不容易啊(我哭)。接下来就要进入正常的更新阶段了,1-2周更新一次,可能有点慢请各位小伙伴们谅解哈。