《机器人动力学与控制》第九章——动力学 9.4 欧拉-拉格朗日方程法应用举例(上)

《机器人动力学与控制》第九章——动力学

9.4 欧拉-拉格朗日方程法应用举例(上)

本节我们用前面学到的欧拉-拉格朗日方程分析法来分析四种不同结构的机械臂,并尝试着推导对应的动力学方程。这些例子由简入深,我们先从一个双连杆机械臂开始,最后到一个具有五个连杆的机械臂。这里建议大家自己跟着过程推一波公式,虽然不一定能让你对动力学有更深层次的理解(步骤都是死的),但起码可以通过推导2轴机器人去感受6轴机器人动力学公式的恐怖。

9.4.1. 双连杆笛卡尔机械臂

考虑下图具有两个连杆和两个移动关节的机械臂:
在这里插入图片描述
分别用 m 1 m_1 m1 m 2 m_2 m2 来表示连杆1和连杆2的质量,用 q 1 q_1 q1 q 2 q_2 q2 来表示两个关节的位移量,用 f 1 f_1 f1 f 2 f_2 f2 来表示作用在每个关节的力。因为没有转动关节,因此我们不需要考虑转动动能与转动势能。

动能

由于 q 1 q_1 q1 q 2 q_2 q2 可以用来表达这个系统的generalized coordinate(这句话直译,具体含义没搞懂),动能可以用如下公式表达:
在这里插入图片描述
势能仅仅与q1和q2有关,我们用9.3节学到的公式来推导动力学方程。两个关节只有位移没有旋转,所以角速度Jacobian系数为零,该系统的动能只与移动关节的位移速度有关。

通过雅各比矩阵的学习可知连杆1重心的速度等于:
在这里插入图片描述
其中
在这里插入图片描述
这里省略了建立坐标系,推导雅各比矩阵的过程,请自行推导。类似地,可以得到:
在这里插入图片描述
因此该系统的全部动能可以表达为
在这里插入图片描述

势能

下面就需要推导势能了,根据机器人的结构可以发现,m1和m2的势能都只与q1有关,很容易就能得到该结构的总势能
在这里插入图片描述

书写动力学方程

有了动能和势能就可以通过写动力学方程了。这里有两种方法,一个是根据定义先写出拉格朗日系数
在这里插入图片描述
然后使用力的计算公式
在这里插入图片描述
第二种方式是用上一节我们刚刚学习的结论,直接套用公式
在这里插入图片描述
可以发现 D(q) 已知,由于dij与q无关,因此Christoffel项都是0。另外D的非对角项都为0,所以动力学公式变为
在这里插入图片描述
由于
在这里插入图片描述
所以最终动力学公式为
在这里插入图片描述

9.4.2.平面肘部机械手

现在我们来看另一个例子,如下图所示,该机器人有且仅有两个旋转关节。
在这里插入图片描述
坐标系都已经在图里面帮你们建好了,请自行验证。Ii代表连杆i关于一根过其质心指向朝外的轴的惯量矩。
我们继续使用雅各比矩阵的知识求解速度先,雅各比矩阵推导规则如下
在这里插入图片描述
首先
在这里插入图片描述
接着
在这里插入图片描述
同理
在这里插入图片描述
在这里插入图片描述
因此动能里面平动部分的能量为
在这里插入图片描述
现在我们来处理转动部分能量,根据该机械结构可以方便的得到
在这里插入图片描述
根据雅各布矩阵得到的也是一样的结果
接着带入动能表达式得到
在这里插入图片描述
把平动部分能量和转动部分能量相加得到
在这里插入图片描述
因此
在这里插入图片描述
接着
在这里插入图片描述
注意,这里面的计算还是比较烦的,我这边省略了不少中间过程直接把结果贴出来。
接下来研究机械臂的势能,势能只与q的大小有关,因此
在这里插入图片描述
所以
在这里插入图片描述
最后我们带入动力学方程得到
在这里插入图片描述
这里面的C项为
在这里插入图片描述
请务必自己推一波,多准备点纸。

参考文献

《robot dynamics and control》 作者:Mark W Spong,Seth Hutchinson, and M. Vidyasagar

  • 5
    点赞
  • 33
    收藏
    觉得还不错? 一键收藏
  • 8
    评论
好的,我可以为您讲解一下拉格朗日方程推导过程,以一维情况为例。 假设一个质点在一维坐标系上运动,其位置用 $q$ 表示,时间用 $t$ 表示。该质点的运动可以用拉格朗日函数 $L(q, \dot{q}, t)$ 描述,其中 $\dot{q}=\frac{dq}{dt}$ 表示质点的速度。 为了推导欧拉-拉格朗日方程,我们首先需要定义一个重要的量,即作用量 $S$。作用量定义为 $$S = \int_{t_1}^{t_2} L(q, \dot{q}, t) dt$$ 其中 $t_1$ 和 $t_2$ 表示质点运动的起点和终点。作用量可以理解为一个积分,它是拉格朗日函数在时间 $t_1$ 到 $t_2$ 内的时间积分。 接下来,我们需要考虑如何对作用量进行变分。变分是一种数学操作,它类似于求导,但是是对函数进行微小的偏移,即对函数进行微小的扰动。对于一个作用量 $S$,其变分可以表示为 $$\delta S = S[q+\delta q] - S[q]$$ 其中 $\delta q$ 表示对 $q$ 进行微小的扰动。 现在我们来考虑如何对作用量进行变分。首先,我们将作用量中的积分拆开,得到 $$\delta S = \int_{t_1}^{t_2} \left( \frac{\partial L}{\partial q} \delta q + \frac{\partial L}{\partial \dot{q}} \delta \dot{q} \right) dt$$ 其中第一个式子中的 $\frac{\partial L}{\partial q}$ 表示对 $L$ 关于 $q$ 的偏导数,第二个式子中的 $\frac{\partial L}{\partial \dot{q}}$ 表示对 $L$ 关于 $\dot{q}$ 的偏导数。 现在我们需要将 $\delta \dot{q}$ 转化为 $\delta q$。由于 $\dot{q}=\frac{dq}{dt}$,我们可以得到 $$\delta \dot{q} = \frac{d}{dt} \delta q$$ 将上式代入到 $\delta S$ 中,得到 $$\delta S = \int_{t_1}^{t_2} \left( \frac{\partial L}{\partial q} \delta q + \frac{\partial L}{\partial \dot{q}} \frac{d}{dt} \delta q \right) dt$$ 接下来,我们需要对第二个式子进行分部积分,得到 $$\delta S = \int_{t_1}^{t_2} \left( \frac{\partial L}{\partial q} - \frac{d}{dt} \frac{\partial L}{\partial \dot{q}} \right) \delta q dt + \left[ \frac{\partial L}{\partial \dot{q}} \delta q \right]_{t_1}^{t_2}$$ 现在我们需要对第二个式子进行讨论。由于质点在运动时,其位置 $q$ 和速度 $\dot{q}$ 在起点和终点上都是确定的,因此 $\delta q$ 在 $t_1$ 和 $t_2$ 处的值都应该为 0。因此,第二个式子等于 0。 最终,我们得到了欧拉-拉格朗日方程: $$\frac{d}{dt} \frac{\partial L}{\partial \dot{q}} - \frac{\partial L}{\partial q} = 0$$ 这个方程描述了质点的运动。如果我们能够求出拉格朗日函数 $L$,那么欧拉-拉格朗日方程就可以帮助我们计算质点的运动。

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论 8
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值