一种横列式双旋翼无人机矢量控制方法技术

本发明专利技术公开了一种横列式双旋翼无人机矢量控制方法。根据双旋翼无人机的动力学模型构建设计滑模控制器；根据输入的双旋翼无人机的期望位置和期望速度处理获得双旋翼无人机在世界坐标系下的加速度，然后解算到双旋翼无人机的执行器的控制量，通过混控器将执行器的控制量叠加到俯仰通道和偏航通道的控制量得到双旋翼无人机的执行器的输出量，进而控制双旋翼无人机矢量飞行。本发明专利技术通过采用基于虚拟控制量的滑模控制，虚拟控制量解算和混控器设计，实现了矢量控制，并且简化了控制器的复杂度，易于在嵌入式端部署。易于在嵌入式端部署。易于在嵌入式端部署。

【技术实现步骤摘要】
一种横列式双旋翼无人机矢量控制方法


[0001]本专利技术涉及无人机领域的一种无人机飞行控制方法，尤其涉及一种横列式双旋翼无人机矢量控制方法。

技术介绍

[0002]横列式双旋翼无人机，主要用于战术运输、客运、医疗、搜救、农用植保等任务，主要优势在于其双旋翼无人机横向安置，机身的纵向体积减少，相对于四旋翼少了两个旋翼和电机少了两个旋翼的动力消耗，整体的消耗降低，续航能力更强，带来的直接好处是相同体积下其运载能力相较于传统的四旋翼有明显的提升，载重能力也更大。
[0003]近年来，多旋翼飞行器在军事和民用领域得到了越来越广泛的应用，目前多旋翼飞行器以四旋翼、六旋翼结构为主，其旋翼无法实现倾转，推力方向固定，无法实现推力矢量控制。随着无人飞行器任务复杂度的提高，固定推力方向的多旋翼飞行器局限性也越来越大，而推力矢量控制对无人飞行器的机动性有非常关键的作用，横列式双旋翼无人机矢量飞行器作为一种新型无人机结构，具备续航时间长和固定翼结合实现垂直起降(vertical take
‑
off and landing,VTOL)等优势，其飞行包线要大于固定翼和旋翼机，具备更大的飞行范围。
[0004]目前，双旋翼无人机的飞控算法非常复杂，不仅要考虑旋翼的控制，还要考虑舵机倾转等方面的特性，对飞控算法及其控制系统的要求远高于四旋翼。

技术实现思路

[0005]针对现有技术存在的问题，本专利技术提出一种横列式双旋翼无人机矢量控制方法。本专利技术通过采用基于虚拟控制量的滑模控制，虚拟控制量解算和混控器设计，实现了矢量控制(双旋翼无人机高度位置和俯仰通道位置控制)，并且简化了控制器的复杂度，易于在嵌入式端部署。
[0006]为了实现上述技术目的，如图1所示，本专利技术的技术方案为：
[0007]方法包括以下步骤：
[0008]1)根据双旋翼无人机的动力学模型构建设计滑模控制器；
[0009]2)滑模控制器根据输入的双旋翼无人机的期望位置和期望速度，处理获得双旋翼无人机在世界坐标系下x轴方向和z轴方向上的加速度u
x
、u
z
，然后将加速度u
x
、u
z
解算到双旋翼无人机的执行器的控制量，包括双旋翼无人机中舵机倾转的角度δ和双旋翼无人机的单个旋翼所产生的推力f，具体公式如下：
[0010][0011]δ＝
‑
a
‑
θ
[0012][0013]式中，δ表示双旋翼无人机中舵机倾转的角度，θ表示双旋翼无人机的俯仰角，a表
示双旋翼无人机的所需推力F方向的倾转角度；f表示双旋翼无人机的单个旋翼所产生的推力；m表示双旋翼无人机的质量；
[0014]3)通过混控器将执行器的控制量δ和f叠加到俯仰通道和偏航通道的控制量得到双旋翼无人机的执行器的输出量δ
L
,δ
R
,f
L
,f
R
，进而控制双旋翼无人机矢量飞行，具体公式：
[0015]δ
L
＝δ+δ
ψ
[0016]δ
R
＝δ
‑
δ
ψ
[0017]f
L
＝f+f
φ
[0018]f
R
＝f
‑
f
φ
[0019]其中，δ
L
,δ
R
分别表示双旋翼无人机的两个旋翼上两舵机的倾斜角度，f
L
,f
R
分别表示双旋翼无人机的两旋翼所产生的推力，δ
ψ
表示偏航通道的舵机倾斜控制量，f
φ
表示横滚通道的旋翼推力的控制量。
[0020]所述的执行器包括了电机和舵机，电机布置在舵机的输出轴上，由舵机带动电机倾斜，执行器用于控制电机的转速和舵机带动电机倾斜的倾斜角度。
[0021]所述1)中的滑模控制器具体为：
[0022]首先，按照以下公式构造滑模面：
[0023][0024]e
x
＝x
d
‑
x
[0025][0026][0027]e
z
＝z
d
‑
z
[0028][0029]式中，s
x
、s
z
分别为沿x轴和z轴的滑模变量，x
d
、x分别表示双旋翼无人机在x轴上的期望位置和实际位置，分别表示双旋翼无人机在x轴上的期望速度和实际速度，e
x
、分别表示双旋翼无人机在x轴上的期望位置与实际位置之间偏差以及期望速度与实际速度之间偏差；z
d
、z分别表示双旋翼无人机在z轴上的期望位置和实际位置，分别表示双旋翼无人机在z轴上的期望速度和实际速度，e
z
、分别表示双旋翼无人机在z轴上的位置偏差和速度偏差；
[0030]然后设计滑模指数趋近律：
[0031][0032]式中，ε表示近滑模面s＝0的速率，k表示指数收敛系数，sgn为符号函数，s表示滑模变量；
[0033]结合上述滑模面和滑模指数趋近律的两式构建出以下滑模控制律：
[0034][0035][0036][0037][0038][0039][0040]其中，分别表示沿x轴和z轴的滑模变量的导数，表示双旋翼无人机在x轴和z轴上的期望加速度与实际加速度的偏差，表示双旋翼无人机在x轴上期望加速度，表示双旋翼无人机在z轴上期望加速度，u
x
表示双旋翼无人机在世界坐标系下x轴方向上的加速度，u
z
表示双旋翼无人机在世界坐标系下z轴方向上的加速度。
[0041]本专利技术首先建立虚拟控制量的控制模型，降低了滑模控制器的设计难度。而且利用控制模型信息来设计滑模控制，控制双旋翼无人机高度位置和俯仰通道位置。最后，通过虚拟控制量解算和混控器设计，来实现控制执行器控制量的输出。
[0042]本专利技术建立世界坐标系，以双旋翼无人机之间的连线方向作为y轴方向，竖直重力向下作为z轴方向，同时垂直于y轴方向和z轴方向的方向为x轴方向。如图2所示，世界坐标系坐标系，x
w
、z
w
分别代表双旋翼无人机在世界坐标系下x轴方向和z轴方向。x轴方向和z轴方向的运动分别代表了俯仰和偏航运动。
[0043]本专利技术采用上述技术方案带来的有益效果有：
[0044]1、控制器框架简单，易于在嵌入式设备上进行部署。
[0045]2、使用虚拟控制量来进一步降低滑模控制器设计难度，更简单。
[0046]3、使用滑模可以提高系统的抗扰特性。
附图说明
[0047]图1是本专利技术流程示意图。
[0048]图2是双旋翼无人机模型示意图。
[0049]图3是双旋翼无人机飞行时示意图。
[005本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种横列式双旋翼无人机矢量控制方法，其特征在于：方法包括以下步骤：1)根据双旋翼无人机的动力学模型构建设计滑模控制器；2)滑模控制器根据输入的双旋翼无人机的期望位置和期望速度，处理获得双旋翼无人机在世界坐标系下x轴方向和z轴方向上的加速度u
x
、u
z
，然后将加速度u
x
、u
z
解算到双旋翼无人机的执行器的控制量，包括双旋翼无人机中舵机倾转的角度δ和双旋翼无人机的单个旋翼所产生的推力f，具体公式如下：δ＝
‑
a
‑
θ式中，δ表示双旋翼无人机中舵机倾转的角度，θ表示双旋翼无人机的俯仰角，a表示双旋翼无人机的所需推力F方向的倾转角度；f表示双旋翼无人机的单个旋翼所产生的推力；m表示双旋翼无人机的质量；3)通过混控器将执行器的控制量δ和f叠加到俯仰通道和偏航通道的控制量得到双旋翼无人机的执行器的输出量δ
L
,δ
R
,f
L
,f
R
，进而控制双旋翼无人机矢量飞行，具体公式：δ
L
＝δ+δ
ψ
δ
R
＝δ
‑
δ
ψ
f
L
＝f+f
φ
f
R
＝f
‑
f
φ
其中，δ
L
,δ
R
分别表示双旋翼无人机的两个旋翼上两舵机的倾斜角度，f
L
,f
R
分别表示双旋翼无人机的两旋翼所产生的推力，δ
ψ
表示偏航通道的舵机倾斜控制量，f
φ
表示横滚通道的旋翼推力的控制量。2.根据权利要求1所述的一种横列式双旋翼无人机矢量控制方法，其特征在于：所述的执行器包括了...

【专利技术属性】
技术研发人员：陆嘉晨，郑恩辉，刘琛，唐勇，
申请(专利权)人：杭州启飞智能科技有限公司，
类型：发明
国别省市：