本发明属于无人机控制技术领域,更为具体地讲,涉及一种基于分数阶幂次切换律的四旋翼无人机飞行控制方法。
背景技术:
随着航空航天技术的发展,以及人们对智能化设备越来越大的需求,无人机开始走进人们的生产、生活甚至是军事活动中,也吸引了一大批科研工作者的注意力,致力于提高其飞行性能,并扩大其应用范围。而四旋翼无人机凭借其诸多优势,如结构简单,飞行灵活,成本较低,尤其是垂直起降等,成为了无人机研究领域中的一大热点。
虽然四旋翼无人机的结构相对简单,但是由于其本身是欠驱动非线性系统,各状态变量间又具有较强的耦合性,因此其控制反而相对复杂。如今对四旋翼飞行器的控制技术正在快速发展,但是都存在一定的问题,如pid控制方法对非线性多输入多输出系统的不适性,反步控制方法较弱的抗干扰和鲁棒特性,以及反步滑模控制方法可能存在的强烈抖动等,都给四旋翼无人机控制方法的研究留下了提升的空间。
分数阶微积分理论是关于任意阶微分、积分的理论,与整数阶微积分几乎同时出现,但又是整数阶微积分的延伸。近年来,分数阶微分方程凭借其对复杂系统的描述具有建模简单、参数物理意义清楚、描述准确等优势,越来越多地被用来描述光学、热学、流变学、材料、力学系统,以及信号处理、系统识别、控制和机器人等他应用领域中的问题,成为复杂力学与物理过程数学建模的重要工具之一。
技术实现要素:
本发明的目的在于克服现有技术的不足,提供一种基于分数阶幂次切换律的四旋翼无人机飞行控制方法,通过设计三个姿态角及高度对应的控制器,来控制四旋翼无人机飞行,具有很强的完整性、鲁棒性以及抗扰动能力。
为实现上述发明目的,本发明一种基于分数阶幂次切换律的四旋翼无人机飞行控制方法,其特征在于,包括以下步骤:
(1)、基于牛顿-欧拉原理对无人机进行动力学分析建立无人机动力学模型
无人机动力学模型包括平移运动模型和旋转运动模型,其中,平移运动模型为:
其中,(x,y,z)为无人机在地坐标系下的位置坐标,
旋转运动模型为:
其中,ix,iy,iz是无人机在x,y,z三个方向上的转动惯量,nx,ny,nz是无人机三个轴方向的力矩;
(2)、分别设计三个姿态角对应的控制器
(2.1)、对滚转角γ进行误差分析:设实际滚转角γ与期望值γd的误差为:eγ1=γ-γd;将eγ1与滚转角误差阈值ζ比较,若eγ1小于阈值ζ,则表示四旋翼无人机飞行系统稳定,并结束;反之则进入步骤(2.2);
(2.2)、设计等效控制律
取虚拟控制变量
定义误差信号
对滑模面sγ(t)求导,得:
根据滑模控制稳定性理论,令
(2.3)、设计基于分数阶理论的切换控制律
其中,kγ>0,0≤q<1,为常系数,
(2.4)、根据等效控制律和基于分数阶理论的切换控制律设计滚转角γ对应的控制器uγ
(2.5)、同理,按照步骤(2.1)-(2.4)所述方法设计俯仰角和偏航角对应的控制器uμ和uρ
(3)、设计高度方向控制器
(3.1)、对高度z进行误差分析:设实际高度z与期望值zd的误差为:ez1=z-zd;将ez1与高度误差阈值
(3.2)、设计等效控制律
取虚拟控制变量
定义误差信号
对滑模面sz(t)求导,得:
根据滑模控制稳定性理论,令
(3.3)、设计基于分数阶理论的切换控制律
其中,εz>0,kz>0,0≤q<1,
(3.4)、根据等效控制律和基于分数阶理论的切换控制律设计高度z对应的控制器uz
(4)、利用设计后的三个姿态角及高度对应的控制器重新跟踪滚转角、俯仰角、姿态角和高度,如果误差均小于其对应的阈值,则表明四旋翼无人机已进入稳定飞行状态,并用上述设计的控制器对四旋翼无人机进行飞行控制,保证无人机正常运行;反之则返回步骤(2)。
本发明的发明目的是这样实现的:
本发明基于分数阶幂次切换律的四旋翼无人机飞行控制方法,控制器整体使用反步控制结构,将四旋翼无人机的二阶非线性系统拆分为两个子系统,并分别构建满足李亚普诺夫稳定性理论的控制律,并通过虚拟中间控制变量将二者串联成为一完整控制器,使控制器能够很好的适配系统的非线性,且具有良好的完整性。同时,为了增强控制器的抗扰动能力和鲁棒性,在第二次反步设计时,对被控变量进行滑模控制设计,引入滑模控制的高抗扰能力、强鲁棒性。但同时为了抑制滑模控制带来的抖动,将滑模控制的趋近律改进为分数阶形式。分数阶系统具有更宽的稳定域以及更多的参数选取方案,使系统在迭代调试时,能够选取到最合适的参数,使切换控制律的切换效果——当被控状态还未到达滑模面,或者因外界干扰等因素偏离滑模面时,控制器的介入程度和控制力度将会与状态与滑模面之间的距离成正比,即当状态离滑模面越远的时候,控制器的作用力度越大,介入程度越高,而越近时则相反——更加快速、稳定,极大地缓减传统滑模控制抖颤特性,以此保证无人机的飞行控制在快速响应的同时,更加平稳,达到优化控制的目的。
同时,本发明基于分数阶幂次切换律的四旋翼无人机飞行控制方法还具有以下有益效果:本发明设计的滑模切换控制律,可以加快被控对象从初始状态到达滑模面的收敛速度,并且保证该状态在滑模面上发生抖动时,能够很快地将被控对象拉回滑模面,并且根据仿真实验,在分数阶滑模切换律的作用下,当被控状态离滑模面越远的时候,控制器的作用力度越大,反之则越小,从而保证了被控状态的稳定和精确。究其原因,有三点:
(1)、一方面,
(2)、另一方面,
(3)、同时,相比整数阶系统的稳定域严格要求特征值只能在虚轴左边,分数阶的引入能够使稳定域向右半平面扩展,即系统的稳定域更宽,参数的选择更多。因此分数阶滑模切换控制律的设计和引入能够使控制器更快速且更稳定地响应和介入,当无人机在飞行过程中遇到外界干扰等情况发生姿态不稳定的情况时,能够在控制器的快速和强力作用下拉回稳定状态,以保证无人飞行器在飞行过程中的稳定。
附图说明
图1是本发明基于分数阶幂次切换律的四旋翼无人机飞行控制方法流程图;
图2是仅考虑姿态控制时,四旋翼无人机实际姿态角与期望姿态角的曲线;
图3无人机进行垂直起飞-直线飞行-垂直降落的仿真实验图;
图4是垂直起飞-直线飞行-垂直降落仿真实验中的实际位置与期望位置对比图;
图5是垂直起飞-直线飞行-垂直降落仿真实验中的实际姿态角与期望姿态角对比图;
图6是垂直起降-矩形飞行仿真实验图;
图7垂直起降-矩形飞行仿真实验中的实际位置与期望位置对比图;
图8垂直起降-矩形飞行仿真实验中的实际姿态角与期望姿态角对比图。
具体实施方式
下面结合附图对本发明的具体实施方式进行描述,以便本领域的技术人员更好地理解本发明。需要特别提醒注意的是,在以下的描述中,当已知功能和设计的详细描述也许会淡化本发明的主要内容时,这些描述在这里将被忽略。
实施例
图1是本发明基于分数阶幂次切换律的四旋翼无人机飞行控制方法流程图。
在本实施例中,如图1所示,本发明一种基于分数阶幂次切换律的四旋翼无人机飞行控制方法,包括以下步骤:
s1、基于牛顿-欧拉原理对无人机进行动力学分析,包括力学分析和力矩分析,建立无人机动力学模型,无人机动力学模型包括平移运动模型和旋转运动模型,其中,平移运动模型为:
其中,(x,y,z)为无人机在地坐标系下的位置坐标,
旋转运动模型为:
其中,ix,iy,iz是无人机在x,y,z三个方向上的转动惯量,nx,ny,nz是无人机三个轴方向的力矩;
s2、分别设计三个姿态角对应的控制器
为了描述更清晰明了,控制器的设计以滚转角γ为例,另外两个姿态角(俯仰角、偏航角)类似;
s2.1、对滚转角γ进行误差分析:设实际滚转角γ与期望值γd的误差为:eγ1=γ-γd;将eγ1与滚转角误差阈值ζ比较,若eγ1小于阈值ζ,则表示四旋翼无人机飞行系统稳定,并结束;反之则进入步骤s2.2;
s2.2、设计等效控制律
取虚拟控制变量
对滚转角γ进行第二步反步控制分析,定义误差信号
对滑模面sγ(t)求导,得:
根据滑模控制稳定性理论,令
s2.3、设计基于分数阶理论的切换控制律
切换控制律的目的是使被控状态始终在滑模面上,或者在滑模面小范围内来回震荡,此处改进的空间在于状态逼近滑模面的速度以及震荡的范围。根据分数阶理论,该发明提出一种基于分数阶理论的滑模控制切换控制律为:
其中,kγ>0,0≤q<1,为常系数,
明显在该分数阶切换控制律能够保证一般切换函数的功能性,而不同的是,
s2.4、综上,将等效控制律与分数阶切换控制律相加,得到滚转角γ控制器uγ为
下面我们来验证该控制律满足李亚普诺夫稳定理论。设李亚普诺夫函数为:
由此可得其导数为:
明显第一项
其中,||sγ(t)||≥0是sγ(t)的范数,同时根据
此时再代入
故
该控制器同时具有反步控制整体性强和分数阶滑模控制器鲁棒性强、抗扰动能力高等优点,还保证了与四旋翼无人机动力学模型的贴合,故实现了前文所述的优良控制特性,对传统四旋翼无人机的姿态控制方法进行了优化。
s2.5、同理,按照步骤s2.1-s2.4所述方法设计俯仰角和偏航角对应的控制器uμ和uρ
s3、设计高度方向控制器,由于其流程与姿态控制器一致,只是公式的表达略有区别,因此在图1中就统一以姿态角中的滚转角为例。
s3.1、对高度z进行误差分析:设实际高度z与期望值zd的误差为:ez1=z-zd;将ez1与高度误差阈值
s3.2、设计等效控制律
取虚拟控制变量
定义误差信号
对滑模面sz(t)求导,得:
根据滑模控制稳定性理论,令
s3.3、设计基于分数阶理论的切换控制律
其中,εz>0,kz>0,0≤q<1,
s3.4、根据等效控制律和基于分数阶理论的切换控制律设计高度z对应的控制器uz
此处的验证与步骤s2.4相同,在此不再赘述。
s4、利用设计后的三个姿态角及高度对应的控制器对四旋翼无人机进行飞行控制,当高度、滚转角、俯仰角和姿态角的误差均小于阈值(一极小正常数)时,说明无人机已进入稳定飞行状态;反之则重新迭代进行步骤s2和s3。
实例
首先在仅考虑姿态控制的情况下,进行分数阶姿态控制器的验证。如图2,分别表示在四旋翼无人机的初始姿态角(滚转角、俯仰角和偏航角)不为0弧度(初值分别为0.315、0.513、0.261弧度),期望值均为0弧度时,四旋翼无人机的姿态角在该控制器下的表现。很明显三个姿态角均能在很短的时间——1秒内收敛到期望值并保持稳定。
在一定的实际应用情况下,验证该分数阶姿态控制器的有效性。此时选择的应用情景为垂直起飞-直线飞行-垂直降落过程,并使用公式
作为期望位置到期望角度的解算器,其中kx,ky为正常数。图3展示了详细过程:首先四旋翼无人机从(0,0,0)位置垂直起飞,上升到(0,0,1.5)位置,然后沿路径y=x前进
图4表示的是整个过程中四旋翼无人机在x,y,z三个方向上的实时位置曲线,其中点划线均为期望位置,实线为实际位置。图像显示在x,y方向上,存在一定误差,而在z方向上,实际位置与期望位置几乎重合。而从实验图像来看,x,y方向的误差也很好地被控制在了0.5米以内,而z方向误差则控制在了10-3数量级。
图5从姿态角方面反应该控制器的良好控制效果。从图5可以看到,滚转角和俯仰角由于与位置关系耦合的原因,容易受到干扰等其他影响因素发生较大幅度的抖颤,如点划线5秒左右所示,而此时实际姿态角在该分数阶控制器的控制下,保证变化趋势的同时,还保持着相对平滑的状态,确保了飞行过程中无人机机身的稳定。而在偏航角方向,由于不存在耦合,实际曲线与期望曲线基本重合。
图6是在更加复杂的情况下进行该分数阶控制器的效果验证。如图中点划线所示,无人机先从点(0,0,0)垂直起飞到点(0,0,5),再沿y轴正方向飞行到点(0,10,5),沿x正方向飞行到点(40,10,5)。然后依次沿y负方向、x负方向,经点(40,0,5)回到点(0,0,5),并最终降落到起飞点(0,0,0)。直观可见,代表实际路径的实线几乎与参考路径点划线几乎重合,只在极少部分存在可见误差。
图7是垂直起降-矩形飞行仿真实验中的实际位置与期望位置对比图,点划线表示期望位置曲线,实线表示实际位置曲线。从图中可以看到,在三个方向上,x、y存在极小的可见误差,从图像来看误差不超过5%(按误差除以路径覆盖范围的最大半径来算)。
图8是垂直起降-矩形飞行仿真实验中的实际姿态角与期望姿态角对比图,由于耦合的关系,滚转角和俯仰角易出现抖动,但在分数阶控制器的作用下,实际姿态角能够对期望姿态角进行平稳且快速地跟踪,保证飞行器在飞行过程中的稳定性。
尽管上面对本发明说明性的具体实施方式进行了描述,以便于本技术领域的技术人员理解本发明,但应该清楚,本发明不限于具体实施方式的范围,对本技术领域的普通技术人员来讲,只要各种变化在所附的权利要求限定和确定的本发明的精神和范围内,这些变化是显而易见的,一切利用本发明构思的发明创造均在保护之列。