CN109976361B - 面向事件触发的四旋翼无人机姿态控制方法 - Google Patents

面向事件触发的四旋翼无人机姿态控制方法 Download PDF

Info

Publication number
CN109976361B
CN109976361B CN201910194876.7A CN201910194876A CN109976361B CN 109976361 B CN109976361 B CN 109976361B CN 201910194876 A CN201910194876 A CN 201910194876A CN 109976361 B CN109976361 B CN 109976361B
Authority
CN
China
Prior art keywords
attitude
unmanned aerial
aerial vehicle
rotor unmanned
quad
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN201910194876.7A
Other languages
English (en)
Other versions
CN109976361A (zh
Inventor
田栢苓
崔婕
鲁瀚辰
刘丽红
宗群
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Tianjin University
Original Assignee
Tianjin University
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Tianjin University filed Critical Tianjin University
Priority to CN201910194876.7A priority Critical patent/CN109976361B/zh
Publication of CN109976361A publication Critical patent/CN109976361A/zh
Application granted granted Critical
Publication of CN109976361B publication Critical patent/CN109976361B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/08Control of attitude, i.e. control of roll, pitch, or yaw
    • G05D1/0808Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/10Simultaneous control of position or course in three dimensions
    • G05D1/101Simultaneous control of position or course in three dimensions specially adapted for aircraft

Landscapes

  • Engineering & Computer Science (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明涉及无人飞行器控制技术领域,为解决四旋翼无人机在模型参数不确定、未建模动态和外界干扰等综合影响下的高精度快速姿态跟踪控制,达到在保证四旋翼无人机控制性能的前提下,节约网络和计算资源、提高系统续航能力的目的。为此,本发明采取的技术方案是,面向事件触发的四旋翼无人机姿态控制方法,步骤如下:第一部分,四旋翼无人机姿态数学模型;第二部分,事件触发机制下的姿态超螺旋控制器设计;第三部分,事件触发规则设计:根据李雅普诺夫稳定性分析设计事件触发规则,通过分析保证内部事件时间大于一个正常数。本发明主要应用于飞行器自动避障控制场合。

Description

面向事件触发的四旋翼无人机姿态控制方法
技术领域
本发明涉及无人飞行器控制技术领域,尤其涉及四旋翼无人机的事件触发姿态控制领域。
背景技术
网络物理系统(Cyber-Physical System,简称CPS)是计算与物理过程的集成。嵌入式计算机、网络监视和控制物理过程之间通常使用反馈回路,其中物理过程影响计算,反之亦然。物理和信息驱动的功能(或网络)之间的交叉代表了挑战,并带来了创新。对于CPS,数字平台和网络的使用成为节省空间、重量和能量的明显趋势。然而,数字实现又会出现其他的挑战,例如需确定控制信号更新和应用的频率,以便仍能保证系统的稳定性。四旋翼无人机作为CPS的一种,在工业和学术研究上越来越受欢迎。在民用上四旋翼无人机有广泛应用,例如道路交通的视频监控、城区监视、森林火灾探测或建筑物检查等。此外,在微型旋翼机无人机中,迷你四旋翼无人机因其高机动性,有效载荷能力和悬停能力引起了国内外极大的研究兴趣。这种垂直起飞和着陆的四旋翼无人机具有一些优于传统直升机的优点:由于其对称性,设计和构造相对简单。实际上,四旋翼无人机是一种欠驱动系统,具有四个输入力和六个输出坐标(姿态和位置)。然而,该系统可以分解为两个子系统,一个定义平移运动,另一个定义旋转运动。这些子系统级联耦合,平移子系统取决于旋转子系统,但旋转子系统独立于平移子系统。自主飞行时需要生成发送到执行机构的低级控制信号以及与引导、导航相关的决策。低级飞行控制被称为姿态控制,它负责维持所需的无人机方向。因此,姿态控制器设计本身就是一个挑战。
目前,经典的线性控制方法,如PID控制算法、LQR控制算法、H控制算法等,和基于现代控制理论提出的非线性控制方法,如滑模控制、反步控制、自适应控制等,因其各自的优点在四旋翼无人机的姿态控制领域被广泛应用。实际上,这些控制方法都是在连续时间框架下制定的,它们在数字平台下的实现是通过“仿真”过程来实现的。该过程包括实现具有恒定且足够小的采样周期的连续时间控制算法。但是,这些方法容易受到硬件限制,并且不可能将采样周期缩短到保证可接受的闭环性能的水平。近年来,一种新的控制机制-事件触发控制方法被提出。事件触发机制的基本思想是首先保证闭环系统稳定,在系统稳定的情况下,一旦预先设定好的事件触发条件不成立,控制任务随即被执行,即:事件触发控制就是控制任务需要时才执行,不需要时不执行,并且还要保证系统的稳定性。其中,事件触发条件通常由事件函数生成,该事件函数指示是否必须更新控制信号,典型的事件检测机制是关于系统状态变化的函数。与传统数字控制方法相比,此方法的优点是:在保证性能的同时减少控制器的更新次数,这意味着可以为与控制器共享网络的其他任务提供更多的带宽,从而节省网络资源,或者可以最小化CPU的使用,节约计算资源,从而降低能量的消耗。
考虑到四旋翼无人机需要节省能量、提高其续航能力的明显趋势,为确保在存在模型参数不确定及未建模动态和外界干扰影响的情况下,实现四旋翼无人机的姿态稳定跟踪控制,节约通信和计算资源、提高其续航能力,本发明首次提出了基于事件触发的超螺旋四旋翼无人机姿态控制方法。本发明提出的方法能够实现四旋翼无人机姿态的高精度快速收敛,同时在保证其控制性能的前提下,减少样本数量,从而降低能耗,提高四旋翼无人机的续航能力
本发明属于四旋翼无人机飞行控制技术领域。具体来说,给出了在模型参数不确定及未建模动态和外界干扰等综合影响下的四旋翼无人机的姿态数学模型,并首次提出了一种不同于以往传统数字控制方法的基于事件触发的超螺旋滑模控制方法,随后通过Simulink仿真分析,验证了本发明提出方法的有效性。
发明内容
为克服现有技术的不足,本发明旨在提出一种应用于四旋翼无人机姿态的基于事件触发的超螺旋控制方法,解决四旋翼无人机在模型参数不确定、未建模动态和外界干扰等综合影响下的高精度快速姿态跟踪控制,达到在保证四旋翼无人机控制性能的前提下,节约网络和计算资源、提高系统续航能力的目的。为此,本发明采取的技术方案是,面向事件触发的四旋翼无人机姿态控制方法,步骤如下:
第一部分,四旋翼无人机姿态数学模型:根据四旋翼无人机姿态的力矩分析,建立欧拉姿态数学模型,同时考虑实际姿态要跟踪期望姿态,进一步建立姿态的误差模型,通过设计事件触发机制下的姿态控制器,使姿态误差收敛到零;
第二部分,事件触发机制下的姿态超螺旋控制器设计:对四旋翼无人机的姿态环进行事件触发机制下的超螺旋控制器设计,最终使得四旋翼无人机实现对期望姿态的快速稳定跟踪控制;
第三部分,事件触发规则设计:根据李雅普诺夫稳定性分析设计事件触发规则,通过分析保证内部事件时间大于一个正常数。
为了验证本发明提出方法的有效性,搭建事件触发机制下的四旋翼无人机姿态超螺旋控制的MATLAB/Simulink仿真系统,并对仿真结果进行分析,确保本发明提出的方法在模型参数不确定及未建模动态和外界干扰存在下的有效性。
具体地:
第一步,四旋翼无人机姿态模型,依据无人机的多变量特性,同时考虑模型参数不确定及未建模动态和外界干扰存在的情况,根据力矩分析得出四旋翼无人机姿态系统模型:
Figure BDA0001995463360000021
其中,Θ=[φ,θ,ψ]T表示四旋翼无人机的姿态,φ表示滚转角,θ表示俯仰角,ψ表示偏航角;Ω=[ωxyz]T表示姿态角速度;I=diag[Ix,Iy,Iz]是飞行器惯性矩阵;τ=[τ123]T表示控制转矩;△(t)表示模型参数不确定及未建模动态和外界干扰的综合;矩阵W定义如下
Figure BDA0001995463360000022
针对四旋翼无人机姿态系统(1),引入中间变量
x1=Θ,x2=WΩ (2)
定义姿态跟踪误差
Figure BDA0001995463360000031
其中Θref=[φrefrefref]表示无人机的期望姿态,则基于姿态跟踪误差的动态系统表述为:
Figure BDA0001995463360000032
定义E(t)=[E1(t) E2(t)]T,则式(4)重新表达为:
Figure BDA0001995463360000033
其中
Figure BDA0001995463360000034
I33是3×3的单位矩阵,
Figure BDA0001995463360000035
是直积,函数f(E(t))=[E2(t) F(t)]T满足Lipschitz条件,即||f(ξ1(t))-f(ξ2(t))||≤L||ξ1(t)-ξ2(t)||,L称为Lipschitz常数;||△′(t)||<δ,
Figure BDA0001995463360000036
δ和
Figure BDA0001995463360000037
是两个已知的常数;
第二步,事件触发机制下的四旋翼无人机姿态超螺旋控制器设计,设计滑模面s1(t)如下:
s1(t)=cTE(t)=E1(t)+E2(t) (6)
定义
Figure BDA0001995463360000038
为触发时刻序列,在时间t∈[ti,ti+1)内,设计虚拟控制变量τ′(t)为
Figure BDA0001995463360000039
其中
Figure BDA00019954633600000310
k1和k2满足以下条件:
Figure BDA00019954633600000311
其中
Figure BDA00019954633600000312
对式(6)求导,得到:
Figure BDA00019954633600000313
其中
Figure BDA00019954633600000314
第三步,事件触发规则设计,根据下面的李雅普诺夫稳定性证明可以得出:系统的稳定性条件有两个,一个是式(8),一个是下列不等式:
Figure BDA00019954633600000315
其中定义测量误差e(t)=E(ti)-E(t)且e(ti)=E(ti)-E(ti)=0,0<σ<1,α>0,式(10)对于所有的t≥0都满足。
李雅普诺夫稳定性证明:第一步:证明滑模变量s1(t),s2(t)在有限时间内收敛到滑模域,定义以下变量:
Figure BDA0001995463360000041
考虑公式(9),以上两个变量的导数为:
Figure BDA0001995463360000042
设计李雅普诺夫函数如下:
Figure BDA0001995463360000043
其中,
Figure BDA0001995463360000044
因为||s1(ti)||=||s1(t)+cTe(t)||,由稳定性条件(10)和Cp不等式可以得出以下不等式:
Figure BDA0001995463360000045
其中
Figure BDA0001995463360000046
当signs1(ti)=signs1(t)时,李雅普诺夫函数的导数为:
Figure BDA0001995463360000047
其中
Figure BDA0001995463360000051
是有界的,式(15)中的Q如下:
Figure BDA0001995463360000052
为了保证Q是正定的,需满足以下条件:
Figure BDA0001995463360000053
很明显,在条件(8)下,Q是正定的,由于
Figure BDA0001995463360000054
λmax(Q)、λmin(Q)是Q的最大、最小特征值,式(15)重新写为:
Figure BDA0001995463360000055
Figure BDA0001995463360000056
时,其中0<κ<1,式(18)可写为:
Figure BDA0001995463360000057
由于
Figure BDA0001995463360000058
λmax(P)、λmin(P)是P的最大、最小特征值,所以
Figure BDA0001995463360000059
则滑模变量s1(t),s2(t)在有限时间t≥T1收敛到零,其中
Figure BDA00019954633600000510
Figure BDA00019954633600000511
时,即
Figure BDA00019954633600000512
且其是
Figure BDA00019954633600000513
的一个子集,
当signs1(ti)≠signs1(t)时,李雅普诺夫函数V是有界的,滑模变量s1(t)收敛到以下域内
Figure BDA0001995463360000061
第二步:证明系统状态变量E1(t),E2(t)是有界的,考虑到滑模面的设计及滑模域,得出:
Figure BDA0001995463360000062
选取李雅普诺夫函数
Figure BDA0001995463360000063
并对其求导得到:
Figure BDA0001995463360000064
Figure BDA0001995463360000065
时,
Figure BDA0001995463360000066
Figure BDA0001995463360000067
时,V2是递减的,所以,闭环系统是有界的,且收敛到域
Figure BDA0001995463360000068
内。
以上两步完成稳定性证明,并得出稳定性条件(8)和(10)。
本发明的特点及有益效果是:
通过仿真的验证和分析,充分表明本发明提出的基于事件触发的超螺旋控制方法的可行性,并实现了四旋翼无人机姿态的高精度、快速稳定跟踪,降低了控制信号的更新次数、减少了计算成本并节省了能量。
附图说明:
附图1事件触发机制下的四旋翼无人机姿态控制系统结构图。
附图2四旋翼无人机的姿态跟踪曲线。
附图3四旋翼无人机的姿态跟踪误差曲线。
附图4四旋翼无人机的控制信号。
附图5事件触发机制下的滑模面变化曲线。
附图6事件触发机制下的内部事件时间的变化。
具体实施方式
本发明的目的在于提出一种应用于四旋翼无人机姿态的基于事件触发的超螺旋控制方法。具体而言,考虑四旋翼无人机降低能耗、提高续航能力的迫切需求,在综合考虑模型参数不确定、未建模动态及外界干扰的影响下,提出一种事件触发机制下的四旋翼无人机姿态超螺旋控制方法,该方法突破了传统数字控制算法等间隔采样的不足,首次提出了基于系统状态采样的事件触发超螺旋控制方法,解决了四旋翼无人机在模型参数不确定、未建模动态和外界干扰等综合影响下的高精度快速姿态跟踪控制,从而达到在保证四旋翼无人机控制性能的前提下,节约网络和计算资源、提高系统续航能力的目的。
本发明提出的事件触发机制下的四旋翼无人机姿态超螺旋控制方法的总体技术方案如图1所示,整个系统主要包括三部分:四旋翼无人机姿态数学模型、事件触发机制下的姿态超螺旋控制器和事件触发规则,具体技术方案如下:
第一部分,四旋翼无人机姿态数学模型:根据四旋翼无人机姿态的力矩分析,建立欧拉姿态数学模型,同时考虑实际姿态要跟踪期望姿态,进一步建立姿态的误差模型,通过设计事件触发机制下的姿态控制器,使姿态误差收敛到零。
第二部分,事件触发机制下的姿态超螺旋控制器设计:考虑模型参数不确定及未建模动态和外界干扰,对四旋翼无人机的姿态环进行事件触发机制下的超螺旋控制器设计,最终使得四旋翼无人机实现对期望姿态的快速稳定跟踪控制。
第三部分,事件触发规则设计:根据李雅普诺夫稳定性分析设计事件触发规则,保证了系统的稳定性。此外,为了保证控制信号不连续时间更新,即避免Zeno现象,需要通过分析保证内部事件时间大于一个正常数。通过以上举措确保事件触发机制下系统的稳定性并避免Zeno现象。
最后,为了验证本发明提出方法的有效性,搭建事件触发机制下的四旋翼无人机姿态超螺旋控制的MATLAB/Simulink仿真系统,并对仿真结果进行分析,确保本发明提出的方法在模型参数不确定及未建模动态和外界干扰存在下的有效性。
为了验证本发明提出的事件触发机制下的四旋翼无人机姿态超螺旋控制算法的有效性,首先将事件触发机制下的四旋翼无人机姿态控制系统在MATLAB/Simulink中进行集成设计,并进行了仿真实验,主要仿真过程如下:
(1)参数设置
1)四旋翼无人机期望姿态:假设四旋翼无人机螺旋上升,则期望φ,θ,ψ方向的姿态信息设为:φref=0.5sint,θref=0.5cost,ψref=0。
2)四旋翼无人机物理参数:飞行器质量m=0.625kg,惯性参数Ix=2.3×10-3kgm2,Iy=2.4×10-3kgm2,Iz=2.6×10-3kgm2
3)控制器参数设置:姿态环控制器参数k1=4,k2=9;事件触发规则参数L=1,σ=0.2,α=0.005。
仿真测试验证过程中,采样时间设置为定步长4毫秒,仿真时间为30秒,姿态综合干扰用时变函数△=I[1+sin(t);1+cos(t);0.5(cos(t)+sin(t))]来进行模拟。
(2)结果分析
在上述给定的条件下,对本发明提出的方法进行仿真验证并分析仿真结果,仿真结果如图2~图6和表1所示。
表1不同的α对系统性能的影响
Figure BDA0001995463360000081
其中,图2是四旋翼无人机姿态跟踪的仿真结果;图3是四旋翼无人机姿态跟踪误差的仿真结果;图4是四旋翼无人机的姿态控制信号的仿真结果;图5事件触发机制下的滑模面变化的仿真结果;图6是事件触发机制下的内部事件时间变化的仿真结果。表1是不同的α对系统性能的影响的仿真结果。
事件触发机制下的四旋翼无人机姿态超螺旋控制结果分析:图2给出了事件触发机制下的超螺旋控制的姿态跟踪曲线,从中可以看出此方法能够使四旋翼无人机的实际姿态快速稳定跟踪期望姿态,表明了该方法的有效性和可行性。图3是姿态的跟踪误差曲线,可以看出误差稳定在零附近,从姿态跟踪误差放大图可以得到α=0.005时滚转、俯仰和偏航三个方向上的最大姿态跟踪误差都分别为6.2*10-2弧度,4.8*10-2弧度和6.6*10-2弧度。图4给出了四旋翼无人机控制信号τ′1、τ′2、τ′3的曲线,从中可以看出控制信号的抖振比滑模控制的明显减少,表明了此超螺旋控制方法能够削弱抖振现象。图5是事件触发机制下的滑模变量的变化曲线,此结果表明滑模变量在有限时间内到达滑模域。图6是事件触发控制中的内部事件时间Ti的变化,从中可以看出Ti一直是正常数,因此触发时刻的Zeno现象不会发生,同时触发时刻的数量为689,即控制信号的更新次数为689,而连续时间下控制信号更新的次数为7501,大大降低了控制信号的更新次数。表1给出了不同的α对系统性能的影响,从中可以看出随着α的增大,触发时刻的数量在减少,误差精度在降低,这意味着如果需要增加误差精度需要更多的样本数量,我们可以通过选择适当的α在保证系统性能的同时降低样本数量。
以上仿真的验证和分析,充分表明了本文提出的基于事件触发的超螺旋控制方法的可行性,并实现了四旋翼无人机姿态的高精度、快速稳定跟踪,降低了控制信号的更新次数、减少了计算成本并节省了能量。
本发明以基于有限时间的控制理论为主要研究手段,提出一种事件触发机制下的四旋翼无人机姿态控制方法,具体实现过程如下。
第一步,四旋翼无人机姿态模型。依据无人机的多变量特性,同时考虑模型参数不确定及未建模动态和外界干扰存在的情况,根据力矩分析得出四旋翼无人机姿态系统模型:
Figure BDA0001995463360000091
其中,Θ=[φ,θ,ψ]T表示四旋翼无人机的姿态,φ表示滚转角,θ表示俯仰角,ψ表示偏航角;Ω=[ωxyz]T表示姿态角速度;I=diag[Ix,Iy,Iz]是飞行器惯性矩阵;τ=[τ123]T表示控制转矩;△(t)表示模型参数不确定及未建模动态和外界干扰的综合;矩阵W定义如下
Figure BDA0001995463360000092
针对四旋翼无人机姿态系统(1),引入中间变量
x1=Θ,x2=WΩ (2)
定义姿态跟踪误差
Figure BDA0001995463360000093
其中Θref=[φrefrefref]表示无人机的期望姿态,则基于姿态跟踪误差的动态系统可表述为
Figure BDA0001995463360000094
定义E(t)=[E1(t) E2(t)]T,则式(4)可重新表达为:
Figure BDA0001995463360000095
其中
Figure BDA0001995463360000096
I33是3×3的单位矩阵,
Figure BDA0001995463360000097
是直积,函数f(E(t))=[E2(t) F(t)]T满足Lipschitz条件,即||f(ξ1(t))-f(ξ2(t))||≤L||ξ1(t)-ξ2(t)||,L为Lipschitz常数;
Figure BDA0001995463360000098
δ和
Figure BDA0001995463360000099
是两个已知的常数。
第二步,事件触发机制下的四旋翼无人机姿态超螺旋控制器设计。设计滑模面s1(t)如下:
s1(t)=cTE(t)=E1(t)+E2(t) (6)
定义
Figure BDA00019954633600000910
为触发时刻序列,在时间t∈[ti,ti+1)内,设计虚拟控制变量τ′为
Figure BDA00019954633600000911
式(7)中
Figure BDA00019954633600000912
且k1和k2满足以下条件:
Figure BDA00019954633600000913
其中
Figure BDA00019954633600000914
对式(6)求导,得到:
Figure BDA0001995463360000101
其中
Figure BDA0001995463360000102
第三步,事件触发规则设计。根据下面的李雅普诺夫稳定性证明可以得出:系统的稳定性条件有两个,一个是式(8),一个是下列不等式:
Figure BDA0001995463360000103
其中定义测量误差e(t)=E(ti)-E(t)且e(ti)=E(ti)-E(ti)=0,0<σ<1,α>0,式(10)对于所有的t≥0都满足。
李雅普诺夫稳定性证明。第一步:证明滑模变量s1(t),s2(t)在有限时间内收敛到滑模域。定义以下变量:
Figure BDA0001995463360000104
考虑公式(9),以上两个变量的导数为:
Figure BDA0001995463360000105
设计李雅普诺夫函数如下:
Figure BDA0001995463360000106
其中,
Figure BDA0001995463360000107
因为||s1(ti)||=||s1(t)+cTe(t)||,由稳定性条件(10)和Cp不等式可以得出以下不等式:
Figure BDA0001995463360000108
其中
Figure BDA0001995463360000109
当signs1(ti)=signs1(t)时,李雅普诺夫函数的导数为:
Figure BDA0001995463360000111
其中
Figure BDA0001995463360000112
是有界的。式(15)中的Q如下:
Figure BDA0001995463360000113
为了保证Q是正定的,需满足以下条件:
Figure BDA0001995463360000114
很明显,在条件(8)下,Q是正定的。由于
Figure BDA0001995463360000115
λmax(Q)、λmin(Q)是Q的最大、最小特征值,式(15)可重新写为:
Figure BDA0001995463360000116
Figure BDA0001995463360000117
时,其中0<κ<1,式(18)可写为:
Figure BDA0001995463360000118
由于
Figure BDA0001995463360000119
λmax(P)、λmin(P)是P的最大、最小特征值,所以
Figure BDA0001995463360000121
则滑模变量s1(t),s2(t)在有限时间t≥T1收敛到零,其中
Figure BDA0001995463360000122
Figure BDA0001995463360000123
时,即
Figure BDA0001995463360000124
且其是
Figure BDA0001995463360000125
的一个子集。
当signs1(ti)≠signs1(t)时,李雅普诺夫函数V是有界的,滑模变量s1(t)收敛到以下域内
Figure BDA0001995463360000126
第二步:证明系统状态变量E1(t),E2(t)是有界的。考虑到滑模面的设计及滑模域,可以得出:
Figure BDA0001995463360000127
选取李雅普诺夫函数
Figure BDA0001995463360000128
并对其求导得到:
Figure BDA0001995463360000129
Figure BDA00019954633600001210
时,
Figure BDA00019954633600001211
Figure BDA00019954633600001212
时,V2是递减的。所以,闭环系统是有界的,且收敛到域
Figure BDA00019954633600001213
内。
以上两步完成稳定性证明,并得出稳定性条件(8)和(10)。
根据上述分析,事件触发规则设计如下:
Figure BDA0001995463360000131
避免Zeno现象。定义内部事件时间Ti=ti+1-ti,其中i∈Z≥0。由于||e(t)||在时间[ti,ti+1)里从0增到
Figure BDA0001995463360000132
所以对其求导得:
Figure BDA0001995463360000133
微分方程(27)的解为:
Figure BDA0001995463360000134
当t=ti+1时,可以得到:
Figure BDA0001995463360000135
定义函数
Figure BDA0001995463360000136
由于函数g(Ti)在Ti≥0里是单调递增的且
Figure BDA0001995463360000137
所以不等式(29)的解为Ti≥β>0,其中g(β)=0。因此,触发规则不会造成Zeno执行。
以上三部分为本发明技术方案的详细公式推导。

Claims (3)

1.一种面向事件触发的四旋翼无人机姿态控制方法,其特征是,步骤如下:
第一部分,四旋翼无人机姿态数学模型:根据四旋翼无人机姿态的力矩分析,建立欧拉姿态数学模型,同时考虑实际姿态要跟踪期望姿态,进一步建立姿态的误差模型,通过设计事件触发机制下的姿态控制器,使姿态误差收敛到零;
第二部分,事件触发机制下的姿态超螺旋控制器设计:对四旋翼无人机的姿态环进行事件触发机制下的超螺旋控制器设计,最终使得四旋翼无人机实现对期望姿态的快速稳定跟踪控制;
第三部分,事件触发规则设计:根据李雅普诺夫稳定性分析设计事件触发规则,通过分析保证内部事件时间大于一个正常数;
第一步,四旋翼无人机姿态模型,依据无人机的多变量特性,同时考虑模型参数不确定及未建模动态和外界干扰存在的情况,根据力矩分析得出四旋翼无人机姿态系统模型:
Figure FDA0003416890650000011
其中,Θ=[φ,θ,ψ]T表示四旋翼无人机的姿态,φ表示滚转角,θ表示俯仰角,ψ表示偏航角;Ω=[ωxyz]T表示姿态角速度;I=diag[Ix,Iy,Iz]是飞行器惯性矩阵;τ=[τ123]T表示控制转矩;△(t)表示模型参数不确定及未建模动态和外界干扰的综合;矩阵W定义如下
Figure FDA0003416890650000012
针对四旋翼无人机姿态系统(1),引入中间变量
x1=Θ,x2=WΩ (2)
定义姿态跟踪误差
E1(t)=x1ref,
Figure FDA0003416890650000013
其中Θref=[φrefrefref]表示无人机的期望姿态,则基于姿态跟踪误差的动态系统表述为:
Figure FDA0003416890650000014
定义E(t)=[E1(t) E2(t)]T,则式(4)重新表达为:
Figure FDA0003416890650000015
其中
Figure FDA0003416890650000016
I33是3×3的单位矩阵,
Figure FDA0003416890650000017
是直积,函数f(E(t))=[E2(t) F(t)]T满足Lipschitz条件,即||f(ξ1(t))-f(ξ2(t))||≤L||ξ1(t)-ξ2(t)||,L称为Lipschitz常数;||△′(t)||<δ,
Figure FDA0003416890650000018
δ和
Figure FDA0003416890650000019
是两个已知的常数;
第二步,事件触发机制下的四旋翼无人机姿态超螺旋控制器设计,设计滑模面s1(t)如下:
s1(t)=cTE(t)=E1(t)+E2(t) (6)
定义
Figure FDA0003416890650000021
为触发时刻序列,在时间t∈[ti,ti+1)内,设计虚拟控制变量τ′(t)为
Figure FDA0003416890650000022
其中
Figure FDA0003416890650000023
k1和k2满足以下条件:
Figure FDA0003416890650000024
其中
Figure FDA0003416890650000025
对式(6)求导,得到:
Figure FDA0003416890650000026
其中
Figure FDA0003416890650000027
第三步,事件触发规则设计,根据下面的李雅普诺夫稳定性证明可以得出:系统的稳定性条件有两个,一个是式(8),一个是下列不等式:
Figure FDA0003416890650000028
其中定义测量误差e(t)=E(ti)-E(t)且e(ti)=E(ti)-E(ti)=0,0<σ<1,α>0,式(10)对于所有的t≥0都满足。
2.如权利要求1所述的面向事件触发的四旋翼无人机姿态控制方法,其特征是,为了验证本发明提出方法的有效性,搭建事件触发机制下的四旋翼无人机姿态超螺旋控制的MATLAB/Simulink仿真系统,并对仿真结果进行分析,确保本发明提出的方法在模型参数不确定及未建模动态和外界干扰存在下的有效性。
3.如权利要求1所述的面向事件触发的四旋翼无人机姿态控制方法,其特征是,李雅普诺夫稳定性证明:第一步:证明滑模变量s1(t),s2(t)在有限时间内收敛到滑模域,定义以下变量:
Figure FDA0003416890650000029
考虑公式(9),以上两个变量的导数为:
Figure FDA0003416890650000031
设计李雅普诺夫函数如下:
Figure FDA0003416890650000032
其中,
Figure FDA0003416890650000033
因为||s1(ti)||=||s1(t)+cTe(t)||,由稳定性条件(10)和Cp不等式可以得出以下不等式:
Figure FDA0003416890650000034
其中
Figure FDA0003416890650000035
当signs1(ti)=signs1(t)时,李雅普诺夫函数的导数为:
Figure FDA0003416890650000036
其中
Figure FDA0003416890650000037
是有界的,式(15)中的Q如下:
Figure FDA0003416890650000038
为了保证Q是正定的,需满足以下条件:
Figure FDA0003416890650000041
很明显,在条件(8)下,Q是正定的,由于
Figure FDA0003416890650000042
λmax(Q)、λmin(Q)是Q的最大、最小特征值,式(15)重新写为:
Figure FDA0003416890650000043
Figure FDA0003416890650000044
时,其中0<κ<1,式(18)可写为:
Figure FDA0003416890650000045
由于
Figure FDA0003416890650000046
λmax(P)、λmin(P)是P的最大、最小特征值,所以
Figure FDA0003416890650000047
则滑模变量s1(t),s2(t)在有限时间t≥T1收敛到零,其中
Figure FDA0003416890650000048
Figure FDA0003416890650000049
时,即
Figure FDA00034168906500000410
且其是
Figure FDA00034168906500000411
的一个子集,
当signs1(ti)≠signs1(t)时,李雅普诺夫函数V是有界的,滑模变量s1(t)收敛到以下域内
Figure FDA00034168906500000412
第二步:证明系统状态变量E1(t),E2(t)是有界的,考虑到滑模面的设计及滑模域,得出:
Figure FDA0003416890650000051
选取李雅普诺夫函数
Figure FDA0003416890650000052
并对其求导得到:
Figure FDA0003416890650000053
Figure FDA0003416890650000054
时,
Figure FDA0003416890650000055
Figure FDA0003416890650000056
时,V2是递减的,所以,闭环系统是有界的,且收敛到域
Figure FDA0003416890650000057
内;以上两步完成稳定性证明,并得出稳定性条件(8)和(10)。
CN201910194876.7A 2019-03-14 2019-03-14 面向事件触发的四旋翼无人机姿态控制方法 Active CN109976361B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910194876.7A CN109976361B (zh) 2019-03-14 2019-03-14 面向事件触发的四旋翼无人机姿态控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910194876.7A CN109976361B (zh) 2019-03-14 2019-03-14 面向事件触发的四旋翼无人机姿态控制方法

Publications (2)

Publication Number Publication Date
CN109976361A CN109976361A (zh) 2019-07-05
CN109976361B true CN109976361B (zh) 2022-03-25

Family

ID=67078987

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910194876.7A Active CN109976361B (zh) 2019-03-14 2019-03-14 面向事件触发的四旋翼无人机姿态控制方法

Country Status (1)

Country Link
CN (1) CN109976361B (zh)

Families Citing this family (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110456821B (zh) * 2019-08-22 2022-04-12 安徽大学 基于动态触发机制的飞行器轨迹最优控制方法和系统
CN111273688B (zh) * 2020-02-17 2022-11-25 南京邮电大学 基于事件触发的四旋翼无人机一致性编队控制方法
CN111413996B (zh) * 2020-04-09 2023-03-21 中北大学 一种基于事件触发eso的四旋翼保性能轨迹跟踪控制方法
CN112527015B (zh) * 2020-12-04 2023-05-05 广东工业大学 一种基于事件触发的消防无人机编队滑模控制方法
CN112631335B (zh) * 2020-12-29 2023-10-03 南京邮电大学 一种基于事件触发的多四旋翼无人机固定时间编队方法
CN113110066B (zh) * 2021-05-13 2022-04-29 河北科技大学 四旋翼飞行器有限时间Super-Twisting滑模控制方法
CN113377029B (zh) * 2021-06-25 2023-02-24 中国民航大学 一种飞机舵机电动伺服系统多余力矩抑制方法
CN113965109B (zh) * 2021-08-12 2023-10-10 湖南工业大学 一种多电机分层式总量最优协同的抗饱和控制方法
CN113934143B (zh) * 2021-11-24 2023-08-22 苏州科技大学 多旋翼飞行器有限时间自适应事件触发容错跟踪控制方法

Citations (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105159307A (zh) * 2015-08-27 2015-12-16 北京天航华创科技股份有限公司 一种带有执行器饱和问题的运动体姿态事件触发控制方法
WO2016054586A1 (en) * 2014-10-02 2016-04-07 Hunt Advanced Drilling Technologies, LLC Surface steerable drilling system for use with rotary steerable system
CN106774379A (zh) * 2017-03-09 2017-05-31 北京航天自动控制研究所 一种智能超螺旋强鲁棒姿态控制方法
WO2017116533A1 (en) * 2015-12-29 2017-07-06 Echostar Technologies L.L.C. Unmanned aerial vehicle integration with home automation systems
CN107728475A (zh) * 2017-09-19 2018-02-23 天津大学 带有执行器饱和的切换系统事件触发控制设计方法
EP3299296A1 (en) * 2016-09-27 2018-03-28 Airbus Operations Limited Aircraft landing detector
CN108181920A (zh) * 2018-01-31 2018-06-19 天津大学 基于给定时间的四旋翼无人机高精度姿态跟踪控制方法
CN108427430A (zh) * 2018-03-30 2018-08-21 南京航空航天大学 基于网络控制的四旋翼飞行器控制方法
CN108646564A (zh) * 2018-05-25 2018-10-12 安徽大学 一种基于事件触发的不确定再入飞行器模型的设计方法
CN108803317A (zh) * 2018-05-08 2018-11-13 天津大学 自适应多变量四旋翼无人机有限时间容错控制方法
WO2019001076A1 (zh) * 2017-06-26 2019-01-03 深圳市道通智能航空技术有限公司 无人机飞行日志记录方法、装置、存储介质和计算机设备
CN109189085A (zh) * 2018-07-25 2019-01-11 西北工业大学 基于事件触发的航天器网络化系统姿态控制方法

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US10254764B2 (en) * 2016-05-31 2019-04-09 Peloton Technology, Inc. Platoon controller state machine
WO2019033025A1 (en) * 2017-08-10 2019-02-14 Patroness, LLC SYSTEMS AND METHODS FOR IMPROVED AUTONOMOUS OPERATIONS OF A MOTORIZED MOBILE SYSTEM

Patent Citations (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2016054586A1 (en) * 2014-10-02 2016-04-07 Hunt Advanced Drilling Technologies, LLC Surface steerable drilling system for use with rotary steerable system
CN105159307A (zh) * 2015-08-27 2015-12-16 北京天航华创科技股份有限公司 一种带有执行器饱和问题的运动体姿态事件触发控制方法
WO2017116533A1 (en) * 2015-12-29 2017-07-06 Echostar Technologies L.L.C. Unmanned aerial vehicle integration with home automation systems
EP3299296A1 (en) * 2016-09-27 2018-03-28 Airbus Operations Limited Aircraft landing detector
CN106774379A (zh) * 2017-03-09 2017-05-31 北京航天自动控制研究所 一种智能超螺旋强鲁棒姿态控制方法
WO2019001076A1 (zh) * 2017-06-26 2019-01-03 深圳市道通智能航空技术有限公司 无人机飞行日志记录方法、装置、存储介质和计算机设备
CN107728475A (zh) * 2017-09-19 2018-02-23 天津大学 带有执行器饱和的切换系统事件触发控制设计方法
CN108181920A (zh) * 2018-01-31 2018-06-19 天津大学 基于给定时间的四旋翼无人机高精度姿态跟踪控制方法
CN108427430A (zh) * 2018-03-30 2018-08-21 南京航空航天大学 基于网络控制的四旋翼飞行器控制方法
CN108803317A (zh) * 2018-05-08 2018-11-13 天津大学 自适应多变量四旋翼无人机有限时间容错控制方法
CN108646564A (zh) * 2018-05-25 2018-10-12 安徽大学 一种基于事件触发的不确定再入飞行器模型的设计方法
CN109189085A (zh) * 2018-07-25 2019-01-11 西北工业大学 基于事件触发的航天器网络化系统姿态控制方法

Non-Patent Citations (9)

* Cited by examiner, † Cited by third party
Title
Attitude Stabilization of a Quadrotor by Means of Event-Triggered Nonlinear Control;J.F.Guerrero-Castellanos,等;《Journal of Intelligent & Robotic Systems》;20141231;第73卷(第4期);全文 *
Event-triggered fault estimation and sliding mode fault-tolerant control for a class of nonlinear networked control systems;Xiaoan Chu,等;《Journal of the Franklin Institute》;20181231;第355卷(第13期);全文 *
Event-Triggered Finite-Time Integral Sliding Mode Controller for Consensus-Based Formation of Multirobot Systems With Disturbances;Ranjith Ravindranathan Nair,等;《IEEE Transactions on Control Systems Technology》;20190131;第27卷(第1期);全文 *
Event-triggered sliding mode-based tracking control for uncertain Euler–Lagrange systems;Kiran Kumari,等;《IET Control Theory & Applications》;20180930;第12卷(第9期);全文 *
Sliding mode control: A higher order and event triggered based approach for nonlinear uncertain systems;Mrinal Kanti Sarkar,等;《2017 8th Annual Industrial Automation and Electromechanical Engineering Conference (IEMECON)》;20170818;全文 *
事件驱动的卫星编队姿态分布式协同控制;王智鹏,等;《哈尔滨工业大学学报》;20181031;第50卷(第10期);全文 *
基于事件触发器的四旋翼稳定控制;金德智等;《中国科技信息》;20180112(第02期);全文 *
基于滑模方法的分布式多无人机编队控制;周映江等;《信息与控制》;20180615(第03期);全文 *
执行器饱和情况下四旋翼无人机的快速终端滑模控制;马亚丽,等;《信息与控制》;20170228;第46卷(第2期);全文 *

Also Published As

Publication number Publication date
CN109976361A (zh) 2019-07-05

Similar Documents

Publication Publication Date Title
CN109976361B (zh) 面向事件触发的四旋翼无人机姿态控制方法
CN108803317B (zh) 自适应多变量四旋翼无人机有限时间容错控制方法
CN105607473B (zh) 小型无人直升机的姿态误差快速收敛自适应控制方法
Modirrousta et al. A novel nonlinear hybrid controller design for an uncertain quadrotor with disturbances
CN111324138B (zh) 一种四旋翼姿态指定时间保性能输出反馈控制方法
Mokhtari et al. A new robust control for minirotorcraft unmanned aerial vehicles
Zhang et al. Event-triggered adaptive fault-tolerant synchronization tracking control for multiple 6-DOF fixed-wing UAVs
CN111198570B (zh) 一种基于固定时间微分器预测的抗时延高精度自抗扰姿态控制方法
Pucci et al. Nonlinear control of PVTOL vehicles subjected to drag and lift
Bao et al. Design of a fixed-wing UAV controller based on adaptive backstepping sliding mode control method
CN113204191A (zh) 一种无人直升机自抗扰容错控制方法
CN112859913A (zh) 考虑输出约束的多四旋翼无人机姿态一致最优控制方法
Sartori et al. Design and development of a backstepping controller autopilot for fixed-wing UAVs
CN115129072A (zh) 固定翼无人机位置跟踪偏差约束下终端滑模控制方法
Cordeiro et al. Robustness of incremental backstepping flight controllers: The boeing 747 case study
CN114237270A (zh) 一种考虑输入饱和的无人直升机跟踪控制方法
Shen et al. Adaptive neural network extended state observer-based finite-time convergent sliding mode control for a quad tiltrotor uav
CN111176311A (zh) 四旋翼无人机姿态的滑模延时估计控制方法及存储介质
CN114003052B (zh) 一种基于动态补偿系统的固定翼无人机纵向运动鲁棒自适应控制方法
CN114019997B (zh) 固定翼无人机位置跟踪偏差约束下有限时间控制方法
CN113885549B (zh) 基于维度裁剪的ppo算法的四旋翼姿态轨迹控制方法
CN112764426A (zh) 一种四旋翼无人机系统的内模抗扰控制方法
Aruneshwaran et al. Neural adaptive back stepping flight controller for a ducted fan UAV
Brahim et al. Anti-saturation finite time adaptive altitude quadrotor control under unknown disturbances
Meng et al. Research of Tail-Sitter VTOL UAV in Transition Process Based on an Improved L1 Adaptive Control Method

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant