【读书笔记】无人机控制(5)

简介: 该部分介绍为 UAV 设计非线性飞行控制器的主要步骤。该控制系统基于旋翼 UVA 的非线性模型,采用内外环控制方案,考虑了系统的非线性和耦合性,设计了一种易于实现和调试的实用控制器。利用级联系统理论证明了**完全闭环系统的渐近稳定性**。

垂直起降飞行器的数学建模与非线性控制

该部分介绍为 UAV 设计非线性飞行控制器的主要步骤。该控制系统基于旋翼 UVA 的非线性模型,采用内外环控制方案,考虑了系统的非线性和耦合性,设计了一种易于实现和调试的实用控制器。利用级联系统理论证明了完全闭环系统的渐近稳定性

RUAV

旋翼机无人机(RUAV)被广泛应用于多种应用,主要是军用和民用。在城市和室内等复杂杂乱的环境中,在空中监视、侦察和检查具有重大优势。它们的实用性源于其低成本、小尺寸、垂直起降(VTOL)能力以及在极低高度飞行、悬停、巡航和实现攻击性机动的能力。

实际中,RUAV 自动驾驶仪的设计具有许多理论和技术挑战。由于其复杂的动力学、非线性以及控制输入和状态变量之间的高度耦合,设计可靠且鲁棒的控制器是一个挑战。此外,微型飞行器有限的有效载荷对导航传感器和机载电子设备的选择造成了严重限制。在过去十年中,大多数小型RUAV的研究活动都集中于通过推导其动力学的数学模型和合成基本稳定性控制器来解决这些问题。

该部分的目标是设计一个实用的非线性飞行控制器,该控制器具有以下特点:

  • 基于 RUAV 的数学模型,考虑了系统的非线性以及控制变量和状态变量之间的耦合。
  • 是一个多用途控制器,可处理不同的飞行模式,如悬停、向前飞行、侧向飞行、起飞和着陆、轨迹跟踪等。
  • 保证了整个闭环系统的渐近稳定性。
  • 实现板载微处理器很简单,且其结果是良好的飞行性能。

keyword : 级联子系统;渐近稳定性

动力学模型

刚体动力学 (Rigid Body Dynamics)

首先,将旋翼 UAV 视为具有六个空间自由度的刚体。

刚体动力学建模的目的是找到将系统输出(位置和方向)转换为输入(力和扭矩向量)的微分方程。Newton–Euler 方程给出受外力矢量 FbR3 和扭矩矢量 ΓbR3 的影响的质量为 mR 的刚体和惯性矩阵 JR3×3 的运动方程,即

{m˙V+Ω×mV=Fb,J˙Ω+Ω×JΩ=Γb.

其中,V=(u,v,w)Ω=(p,q,r) 分别是物体固定参考系中的线速度和角速度;F 包含了重力、主推力等。该方程建立的坐标系为 body frame。

在这里插入图片描述
不失一般性地,使用欧拉角参数化,从 body frame 到惯性系的旋转矩阵为 R=RψRθRϕ=[cosθcosψsinϕsinθcosψcosϕsinψcosϕsinθcosψ+sinϕsinψcosθsinψsinϕsinθsinψ+cosϕcosψcosϕsinθsinψsinϕcosψsinθsinϕcosθcosϕcosθ],

其中,η=(ϕ,θ,ψ) 代表三个欧拉角的矢量。进而,可将重力与其他作用力分离,且平移动力学可表示为

˙ξ=v,m˙v=RFbmgei3.

此处,ξv 表示位置与速度。 > 在相关文献中,除去基于欧拉角表示旋转动力学外,基于四元数也是一种常用方法。 首先建立角速度 Ω 与欧拉角 η 的映射关系,即 ˙η=Φ(η)Ω,
其中欧拉矩阵 Φ(η)=[1sinϕtanθcosϕtanθ0cosϕsinθ0sinϕsecθcosϕsecθ].
对 (2) 中的时间进行微分,结合 (1) 可得 ¨η=˙ΦΩ=˙ΦΨ˙ηΦJ1sk(Ω)JΩ+ΦJ1Γb,
此处的算子 sk:R3R3×3,且 sk(x)$$sk(x)yx×y.$(3)$M(η)=Ψ(η)TJΨ(η)$
M(\eta) \ddot{\eta} + C(\eta, \dot{\eta}) \dot{\eta} = \Psi(\eta) \Gamma^{b},Coriolis$C(η,˙η)=Ψ(η)TJΨ(˙η)+Ψ(η)Tsk(Ψ(η)˙η)JΨ(η)$.RUAV线

{m¨ξ=RFbmgei3,M(η)¨η+C(η,˙η)˙η=Ψ(η)TΓb.

\tag{4}

### 空气动力学力与力矩 (Aerodynamics Forces and Torques) 具体而言,本部分给出 (4) 中的 $F^{b}$ 和 $\Gamma^{b}$. 大多数垂直起降飞行器都是欠驱动机械系统,具有六个自由度和四个主控制输入。事实上,许多小型旋翼机无人机的特点是有三个主要控制力矩 $\tau = (\tau_{\phi}, \tau_{\theta}, \tau_{\psi})^{\rm T}$ 和一个主控制力 $F{b} = (0, 0, u)^{\rm T}$。假设忽略由控制输入耦合和其他小的力和力矩(如气动效应、转子动力学、陀螺效应等)。 假设螺旋桨推力和扭矩与转子角速度 $\omega$ 的平方成正比,产生力和控制力矩的代数模型可以写成

[uτϕτθτψ]

= [ρρρρ 0lρ0lρ lρ0lρ0 κκκκ]
[ω21ω22ω23ω24]

(4)

{m¨ξ=uRei3mgei3,M(η)¨η+C(η,˙η)˙η=Ψ(η)Tτ.

\tag{5}

## 非线性分层飞行控制器的设计与稳定性 目标是设计一个在实践和理论上都表现良好的 3D 飞行控制器。事实上,控制系统需要易于实施和调整,同时保证良好的飞行性能。此外,分析闭环系统的稳定性也很重要。为了实现这一目标,利用旋翼机无人机模型的结构特性,将旋翼机模型分为两个相互连接的子系统。具有快速动力学的内环执行姿态跟踪并产生所需扭矩。具有慢动力学的外环用于产生推力和参考角,以遵循指令的平动轨迹,并证明了完全连通系统的渐近稳定性。 ### 飞行控制器设计 强耦合非线性系统的控制器设计具有重要的现实意义和理论挑战,因而,通过将非线性模型 (5) 转换为两个由非线性互联项耦合的线性子系统,讨论微型旋翼无人机的控制设计。 通过变量替换

\tau = J \Psi(\eta) \tilde{\tau} + \Psi^{- 1} C(\eta, \dot{\eta}) \dot{\eta},$R$(5)

{¨x=1mu(cosϕsinθcosψ+sinϕsinψ),¨y=1mu(cosϕsinθsinψsinϕcosψ),¨z=1mucosϕcosθg,¨ϕ=˜τϕ,¨θ=˜τθ,¨ψ=˜τψ.

\tag{6}
$$ 基于上式,将系统转换为两个级联子系统。

  • 首先定义一个虚拟控制向量 μR3μ=f(u,ϕd,θd,ψs)=1muR(ϕd,θd,ψs)ei3gei3.
    此处,f:R3R3 是一个连续可逆函数。进一步地,控制向量的分量给定为 {μx=1mu(cosϕdsinθdcosψd+sinϕdsinψd),μy=1mu(cosϕdsinθdsinψdsinϕdcosψd),μz=1mucosϕdcosθdg.
    该分量用于跟踪某些参考轨迹。
  • 上述控制输入可由外环控制器计算得出 (u,ϕd,θd)=f1(μx,μy,μz),即 {u=mμ2x+μ2y+(μz+g)2,ϕd=sin1(mμxsinψdμycosψdu),θd=tan1(μxcosψd+μysinψdμz+g).
  • 由于所需角度 (ϕd,θd,\psi_{d})e = (e_{\eta}, e_{\dot{\eta}})^{\rm T} \in \mathbb{R}^{6}e_{\eta} = \eta - \eta_{d}, e_{\dot{\eta}} = \dot{\eta} - \dot{\eta}_{d}(6)$ \begin{cases} \ddot{x} = \frac{1}{m} u \left[\left(\cos \phi_{d} \sin \theta_{d} \cos \psi_{d} + \sin \phi_{d} \sin \psi_{d}\right) + h_{x}(\phi_{d}, \theta_{d}, \psi_{d}, e_{\phi}, e_{\theta}, e_{\psi})\right] = \mu_{x} + \frac{1}{m} u h_{x}(\cdot), \\ \ddot{y} = \frac{1}{m} u \left[\left(\cos \phi_{d} \sin \theta_{d} \sin \psi_{d} - \sin \phi_{d} \cos \psi_{d}\right) + h_{y}(\phi_{d}, \theta_{d}, \psi_{d}, e_{\phi}, e_{\theta}, e_{\psi})\right] = \mu_{y} + \frac{1}{m} u h_{y}(\cdot), \\ \ddot{z} = \frac{1}{m} u \left[\cos \phi \cos \theta + h_{z}(\phi_{d}, \theta_{d}, e_{\phi}, e_{\theta})\right] - g = \mu_{z} + + \frac{1}{m} u h_{z}(\cdot). \end{cases}

$$ - 通过定义位置-速度跟踪误差 $\chi = (\xi - \xi_{d}, \nu - \nu_{d})^{\rm T} \in \mathbb{R}^{6}$,结合上式与 (6) 可写作矩阵形式。 ### 稳定性证明 ![在这里插入图片描述](https://ucc.alicdn.com/images/user-upload-01/399cc5ecbf1444c988b6568d79bffada.png?x-oss-process=image/watermark,type_d3F5LXplbmhlaQ,shadow_50,text_Q1NETiBATGlicmFWYW4=,size_20,color_FFFFFF,t_70,g_se,x_16#pic_center)

目录
打赏
0
0
0
0
1
分享
相关文章
带你读《无人机网络与通信》之一:无人机系统概述
本书针对无人机系统两个关键问题—通信组网和管控体系做了比较全面和深入的描述和探讨,特别是以大量笔墨分析了现有无线通信解决方案,对比了不同通信协议,得出了很有价值的研究结论。无人机的跨越式发展将涉及公共安全管理的问题,构建管控体系是当务之急,分级管理以及制定相应的适航标准是一件大事情,本书对此也进行了系统的、建设性的讨论。未来,高档无人机和无人机集群将对环境具有更强的感知能力和自适应能力,还有对任务的自规划和学习、调整能力,本书讨论的内容将为它们的发明、部署和监督提供宝贵的信息。
|
5月前
|
从零开始学习无人机 00 硬件配置
关于无人机硬件配置的介绍,包括遥控器乐迪Radiolink AT9S Pro的型号和固件更新、光流传感器思动智能ThoneFlow-3901U及其开发文档、距离传感器空循环Nooploop TOFSense-F Pro及其开发文档。同时,文章还涉及了使用Liftoff软件进行仿真训练的步骤,包括遥控器连接、校准以及训练方法。
52 0
【读书笔记】无人机控制(4)
QTW-UAV可实现垂直起降;此外,直升机特有的悬停飞行和固定翼飞机特有的高速巡航可以通过倾斜机构改变旋翼和机翼的角度来实现。首先,利用辨识方法建立了 QTW-UAV 的姿态模型。然后采用基于卡尔曼滤波的线性二次积分 (LQI) 控制方法设计姿态控制系统;实验结果表明,基于模型的控制设计对于 QTW-UAV 的自主控制非常有效
160 0
【读书笔记】无人机控制(4)
AI助理

你好,我是AI助理

可以解答问题、推荐解决方案等