无人机吊运系统（二级摆）——几何建模

无人机吊运系统（二级摆）——几何建模

---

---

前言

无人机（UAV）由于其高机动性、体积小等优势被广泛应用于吊运任务上，简化的吊运系统一般由无人机本体、轻质绳、重物组成，但实际上无人机吊运系统常常需要单独采用一挂钩另外悬挂重物，如图所示：

（图片来自网络，侵权请联系删除）
即由无人机本体悬挂吊钩（Hook），由吊钩悬挂重物（Payload），过去大部分关于无人机吊运系统的分析工作中，都将模型简化为单摆，但两级摆动实际会对无人机控制带来不小的影响（这在吊车的领域可以看到），为了后续进一步对无人机控制做分析，本文提出从几何角度对无人机吊运系统进行建模，其好处是模型结构相对简洁。

---

一、建模原理

拉格朗日法

定义系统拉格朗日量为：
$$L(q,\dot{q})=T(q,\dot{q})-V(q)$$
其中$q$为系统广义坐标，$T$为系统总动能，$V$为系统总势能，则动力学方程可用拉格朗日函数表示如下：
$$f=\frac{d}{dt}\frac{\partial L}{\partial \dot{q}}-\frac{\partial L}{\partial q}$$

达朗贝尔原则（D’Alembert’s Principle）

对于一个质点系统，每一个质点的动力效应，即实际作用在质点上的力与质点的惯性力（虚拟的力，等于质点质量与加速度乘积的相反数）的矢量和，可以视为在任意虚位移上的总静力效应为零。
数学上表述为：
$$\sum ({\mathbf{F}}_{\mathbf{i}}-m_i{\mathbf{a}}_{\mathbf{i}})\cdot \partial {\mathbf{r}}_{\mathbf{i}}=0$$
其中，${\mathbf{F}}_{\mathbf{i}}$为作用在第$i$个质点的实际力，$m_i$为第$i$个质点的质量，${\mathbf{a}}_{\mathbf{i}}$为第$i$个质点的加速度，$\partial {\mathbf{r}}_{\mathbf{i}}$是一个虚位移。
没有学过理论力学的同学可能不太好第一时间理解，其实达朗贝尔原则的优势在于他化解了面对处于运动状态的系统的受力分析，可以理解为将牛二定律升级为非惯性系下的表述。在拉格朗日力学中，达朗贝尔原则常用于导出拉格朗日方程，这是描述系统动态的基本方程。

二、使用步骤

变量定义：

• ${\mathbf{x}}_{\mathbf{Q}}、{\mathbf{x}}_{\mathbf{h}}、{\mathbf{x}}_{\mathbf{L}}$分别为无人机位置、挂钩位置（hook）、负载位置（Load）；
• $l_1、l_2$：吊绳1、2长度；
• ${\mathbf{p}}_1、{\mathbf{p}}_2$：方向向量，分别代表由无人机质心指向挂钩、由挂钩指向负载；
• $m_Q、m_h、m_L$：分别为无人机质量、挂钩质量（hook）、负载质量（Load）；
• $g$：重力加速度；
• $L$：拉格朗日量；
• $T$：系统总动能；
• $V$：系统总势能；
• $R$：无人机旋转矩阵；

1.系统能量

根据系统示意图，有：
$$\begin{array}{rl}{\mathbf{x}}_{\mathbf{h}}& ={\mathbf{x}}_{\mathbf{L}}-l_2{\mathbf{p}}_2\\ {\mathbf{x}}_{\mathbf{Q}}& ={\mathbf{x}}_{\mathbf{h}}-l_1{\mathbf{p}}_1={\mathbf{x}}_{\mathbf{L}}-l_2{\mathbf{p}}_2-l_1{\mathbf{p}}_1\\ T& =\frac{1}{2}{m}_Q{\mathbf{v}}_{\mathbf{Q}}\cdot {\mathbf{v}}_{\mathbf{Q}}+\frac{1}{2}{m}_h{\mathbf{v}}_{\mathbf{h}}\cdot {\mathbf{v}}_{\mathbf{h}}+\frac{1}{2}{m}_L{\mathbf{v}}_{\mathbf{L}}\cdot {\mathbf{v}}_{\mathbf{L}}+\frac{1}{2}{\Omega }^{\top }J\Omega \\ V& =m_{Q}g{\mathbf{e}}_3\cdot {\mathbf{x}}_{\mathbf{Q}}+m_{h}g{\mathbf{e}}_3\cdot {\mathbf{x}}_{\mathbf{h}}+m_{L}g{\mathbf{e}}_3\cdot {\mathbf{x}}_{\mathbf{L}}\\ \therefore L& =T-V\\ & =\frac{1}{2}{m}_Q\left({\dot{\mathbf{x}}}_L-L_1{\dot{\mathbf{p}}}_1-l_2{\dot{\mathbf{p}}}_2\right)\cdot \left({\dot{\mathbf{x}}}_L-l_1{p}_1-L_2{\dot{\mathbf{p}}}_2\right)+\frac{1}{2}{m}_h\left({\dot{\mathbf{x}}}_L-L_2{\dot{\mathbf{p}}}_2\right)\cdot \left({\dot{\mathbf{x}}}_L-L_1{\dot{\mathbf{p}}}_2\right)\\ & +\frac{1}{2}{m}_L{\dot{\mathbf{x}}}_L\cdot {\dot{\mathbf{x}}}_L+\frac{1}{2}{\Omega }^{\top }J\Omega \\ & -m_{Q}g{\mathbf{e}}_3\cdot \left({\mathbf{x}}_{\mathbf{L}}-L_1{\mathbf{p}}_1-l_2{\mathbf{p}}_2\right)-m_{h}g{\mathbf{e}}_3\cdot \left({\mathbf{x}}_{\mathbf{L}}-L_2{\mathbf{p}}_2\right)-m_{L}g{\mathbf{e}}_3\cdot {\mathbf{x}}_{\mathbf{L}}\end{array}$$
由此构建好二级摆系统的拉格朗日量。

注意：由于无人机姿态在这里与负载动力学解耦，为了主要展现二级摆部分几何建模，后将无人机本体旋转部分能量忽略。

2.建模

准备好拉格朗日方程需要的偏导量：
$$\begin{array}{r}\frac{\partial L}{\partial {\mathbf{x}}_{\mathbf{L}}}=\\ \frac{d}{dt}\frac{\partial L}{\partial {\dot{\mathbf{x}}}_2}=\\ \frac{\partial L}{\partial {\mathbf{p}}_1}=\\ \frac{d}{dt}\frac{\partial L}{\partial {\dot{\mathbf{p}}}_1}=\\ \frac{\partial L}{\partial {\mathbf{p}}_2}=\\ \frac{d}{dt}\frac{\partial L}{\partial {\mathbf{p}}_2}\end{array}$$