CN113419431A - 一种基于事件触发的平流层飞艇轨迹跟踪控制方法及系统 - Google Patents
一种基于事件触发的平流层飞艇轨迹跟踪控制方法及系统 Download PDFInfo
- Publication number
- CN113419431A CN113419431A CN202110834786.7A CN202110834786A CN113419431A CN 113419431 A CN113419431 A CN 113419431A CN 202110834786 A CN202110834786 A CN 202110834786A CN 113419431 A CN113419431 A CN 113419431A
- Authority
- CN
- China
- Prior art keywords
- airship
- value
- representing
- state
- attitude
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 30
- 230000008030 elimination Effects 0.000 claims abstract description 32
- 238000003379 elimination reaction Methods 0.000 claims abstract description 32
- 230000003044 adaptive effect Effects 0.000 claims description 51
- 239000011159 matrix material Substances 0.000 claims description 42
- 230000001960 triggered effect Effects 0.000 claims description 15
- 238000004364 calculation method Methods 0.000 claims description 9
- 230000009466 transformation Effects 0.000 claims description 5
- 230000008878 coupling Effects 0.000 claims description 2
- 238000010168 coupling process Methods 0.000 claims description 2
- 238000005859 coupling reaction Methods 0.000 claims description 2
- 230000007246 mechanism Effects 0.000 description 16
- 238000004891 communication Methods 0.000 description 4
- 230000008569 process Effects 0.000 description 3
- 238000010586 diagram Methods 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000000750 progressive effect Effects 0.000 description 1
- 230000002035 prolonged effect Effects 0.000 description 1
- 239000005437 stratosphere Substances 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
Landscapes
- Engineering & Computer Science (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (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
技术领域
本发明涉及轨迹跟踪控制技术领域,特别是涉及一种基于事件触发的平流层飞艇轨迹跟踪控制方法及系统。
背景技术
无人飞行器的跟踪控制包括轨迹跟踪控制和路径跟踪控制两种,以上两种跟踪控制是当今自主飞行控制研究的热点和难点。轨迹跟踪问题要求被控对象收敛到一条光滑的期望时变轨迹上。
事件触发控制是指控制任务是否执行由事先给定的触发条件决定,而不是根据时间进行周期执行。
目前,引入事件触发的轨迹跟踪控制方法主要是研究如何降低系统的通讯负担和执行器的工作频率。针对分布式系统、大规模系统等通讯负担较重的系统,在传感器与控制器的通讯链路之间增加事件触发机制,当系统的当前状态不满足触发条件时,就不会被传输到控制器,故而能降低系统的通讯频率。针对平流层飞艇这一类对工作寿命要求较高的系统,在控制器和执行器之间增加事件触发机制,当控制器输出的控制量不满足触发条件时,就不会被传输到执行器,因此在触发间隔内执行器不需要改变状态,其工作寿命可以得到显著延长。
然而,对于平流层飞艇来说,传感器的工作寿命同样是制约其驻空时间的主要因素之一。如何利用事件触发机制来降低控制过程中传感器的工作频率则较少被研究。
发明内容
本发明的目的是提供一种基于事件触发的平流层飞艇轨迹跟踪控制方法及系统,降低了传感器的工作频率,提高了飞艇轨迹跟踪系统的工作寿命。
为实现上述目的,本发明提供了如下方案:
一种基于事件触发的平流层飞艇轨迹跟踪控制方法,包括:
根据给定的期望飞行轨迹计算飞艇的期望姿态;
获取飞艇当前时刻的状态观测值与上一触发时刻传感器采集的状态值的误差,记为状态值误差;
当所述状态值误差达到预设值时,触发传感器开始工作并获得当前触发时刻的状态值;两个相邻触发时间间隔内传感器不工作;
根据所述当前触发时刻的状态值确定飞艇的自适应状态观测器;
通过所述自适应状态观测器获取飞艇的状态观测值;
将获得的滑模控制量与执行器的执行量进行比较,获得由所述执行器饱和产生的误差;
根据所述执行器饱和产生的误差确定执行器饱和消除值;
基于滑模控制器,根据所述期望飞行轨迹、所述期望姿态、所述当前触发时刻的状态值、所述当前时刻的状态观测值和所述执行器饱和消除值获得滑模控制量;
将所述滑模控制量传输至所述飞艇的动力装置。
可选地,所述根据给定的期望飞行轨迹计算飞艇的期望姿态的计算公式为:
其中,Θc=[φc,θc,ψc]T表示所述期望姿态,pc=[xc,yc,zc]T表示期望轨迹,φc表示滚转角,θc表示俯仰角,ψc表示偏航角,xc表示x轴坐标,yc表示y轴坐标,zc表示z轴坐标,T表示转置,表示xc的导数,表示yc的导数,表示zc的导数。
可选地,所述传感器采集的状态值包括飞艇的位置、姿态和速度。
可选地,所述自适应状态观测器包括自适应姿态观测器和自适应位置观测器;
根据所述当前触发时刻的状态值和飞艇的姿态动力学模型确定自适应姿态观测器;
根据所述当前触发时刻的状态值和飞艇的位置动力学模型确定自适应位置观测器。
可选地,所述自适应姿态观测器表示为:
其中,表示飞艇姿态角的观测值的导数,表示飞艇体轴系中的角速度的观测值的导数,H1和H2均表示正定的反馈增益矩阵,和分别表示用来补偿事件触发引起的反馈误差的自适应项,表示上一触发时刻传感器发送到滑模控制器的姿态角,表示上一触发时刻传感器发送到滑模控制器的角速度,表示执行器饱和产生的误差,τω表示姿态控制量,B22表示飞艇的转动惯量矩阵的逆,R表示体轴系中的角速度到地轴系中的角速度的转换矩阵,表示飞艇姿态角的观测值,表示飞艇体轴系中的角速度的观测值,Fω表示合外力矩向量;
可选地,所述自适应位置观测器表示为:
其中,表示飞艇位置的观测值的导数,表示飞艇体轴系中的速度的观测值的导数,表示上一触发时刻传感器发送到滑模控制器的体轴系中的速度,表示上一触发时刻传感器发送到滑模控制器的位置,H3和H4均表示正定的反馈增益矩阵,和分别表示用来补偿事件触发引起的反馈误差的自适应项,K表示体轴系中的速度到地轴系中的速度的转换矩阵,表示飞艇位置的观测值,表示飞艇体轴系中的速度的观测值,B11表示飞艇的质量矩阵的逆矩阵;
可选地,所述根据所述执行器饱和产生的误差确定执行器饱和消除值,具体包括:基于辅助设计系统,所述根据所述执行器饱和产生的误差确定执行器饱和消除值;
所述辅助设计系统表示为:
其中,表示第一正定对角常数矩阵,表示第二正定对角常数矩阵,表示位置输入误差和表示姿态输入误差,Bv,0=KB11,Bω,0=RB22,ξv表示表示位置控制饱和消除值,ξω表示姿态控制饱和消除值,表示ξv的导数,表示ξω的导数。
可选地,所述滑模控制量包括位置控制量和姿态控制量:
其中,τω表示姿态控制量,τv表示位置控制量,kv表示正定对角距阵,表示正定对角距阵,s2表示位置动力学模型的滑模面,kω表示正定对角距阵,表示正定对角距阵,s1表示姿态动力模型的滑模面,Fv,0表示耦合速度项的上的外力向量,Fω,0表示耦合角速度项的上的外力矩向量,表示期望轨迹的二阶导数,表示期望姿态的二阶导数,表示期望轨迹的一阶导数,表示期望姿态的一阶导数,和均表示正定对角阵。
本发明公开了一种基于事件触发的平流层飞艇轨迹跟踪控制系统,包括:
期望姿态计算模块,用于根据给定的期望飞行轨迹计算飞艇的期望姿态;
状态值误差获取模块,用于获取飞艇当前时刻的状态观测值与上一触发时刻传感器采集的状态值的误差,记为状态值误差;
当前触发时刻的状态值获得模块,用于当所述状态值误差达到预设值时,触发传感器开始工作并获得当前触发时刻的状态值;两个相邻触发时间间隔内传感器不工作;
自适应状态观测器确定模块,用于根据所述当前触发时刻的状态值确定飞艇的自适应状态观测器;
状态观测值获得模块,用于通过所述自适应状态观测器获取飞艇的状态观测值;
执行器饱和误差产生模块,用于将获得的滑模控制量与执行器的执行量进行比较,获得由所述执行器饱和产生的误差;
执行器饱和消除值确定模块,用于根据所述执行器饱和产生的误差确定执行器饱和消除值;
滑模控制量确定模块,用于基于滑模控制器,根据所述期望飞行轨迹、所述期望姿态、所述当前触发时刻的状态值、所述当前时刻的状态观测值和所述执行器饱和消除值获得滑模控制量;
控制模块,用于将所述滑模控制量传输至所述飞艇的动力装置。
可选地,所述自适应状态观测器包括自适应姿态观测器和自适应位置观测器;
根据所述当前触发时刻的状态值和飞艇的姿态动力学模型确定自适应姿态观测器;
根据所述当前触发时刻的状态值和飞艇的位置动力学模型确定自适应位置观测器。
根据本发明提供的具体实施例,本发明公开了以下技术效果:
本发明根据当前触发时刻的状态值获得飞艇的自适应状态观测器,利用自适应状态观测器对事件触发时间间隔内状态进行观测,两个相邻事件触发时间间隔内传感器不工作,降低了传感器的工作频率,同时利用执行器饱和消除值解决执行器饱和问题。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动性的前提下,还可以根据这些附图获得其他的附图。
图1为本发明一种基于事件触发的平流层飞艇轨迹跟踪控制方法流程示意图;
图2为本发明一种基于事件触发的平流层飞艇轨迹跟踪控制系统结构示意图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
为使本发明的上述目的、特征和优点能够更加明显易懂,下面结合附图和具体实施方式对本发明作进一步详细的说明。
图1为本发明一种基于事件触发的平流层飞艇轨迹跟踪控制方法流程示意图,如图1所示,一种基于事件触发的平流层飞艇轨迹跟踪控制方法包括:
步骤101:根据给定的期望飞行轨迹计算飞艇的期望姿态。
飞艇为平流层飞艇。
根据给定的期望飞行轨迹计算飞艇的期望姿态的计算公式为:
其中,Θc=[φc,θc,ψc]T表示期望姿态,pc=[xc,yc,zc]T表示期望轨迹;,φc表示滚转角,θc表示俯仰角,ψc表示偏航角,xc表示x轴坐标,yc表示y轴坐标,zc表示z轴坐标,T表示转置,表示xc的导数,表示yc的导数,表示zc的导数。
步骤102:获取飞艇当前时刻的状态观测值与上一触发时刻传感器采集的状态值的误差,记为状态值误差。
传感器采集的状态值包括飞艇的位置、姿态和速度。
步骤103:当状态值误差达到预设值时,触发传感器开始工作并获得当前触发时刻的状态值;两个相邻触发时间间隔内传感器不工作。
其中,步骤102和步骤103中触发是指事件触发机制中的事件触发。
事件触发机制,设计为如下形式:
其中X=[X1,X2]T,X1=[x,y,z,φ,θ,ψ]T,X2=[u,v,w,p,q,r]T,X(tk)表示X在触发时刻tk时的值,表示触发间隔[tk,tk+1]内状态观测值,X中包括飞艇的位置,姿态角、体轴系中的速度、体轴系中的角速度,δ1和δ2为大于零的控制器参数。从上述事件触发机制可以看出,当触发条件被满足时,传感器才会工作,并将触发时刻tk的系统状态X(tk)传输至控制器。在触发间隔[tk,tk+1]内,传感器不会工作。(x,y,z)表示飞艇的位置,v、u和w表示体轴系中的速度的三个分量,p、q和r表示体轴系中的角速度在体坐标轴中的三个分量。
τ0为受限制控制输入信号。
步骤104:根据当前触发时刻的状态值确定飞艇的自适应状态观测器。
自适应状态观测器包括自适应姿态观测器和自适应位置观测器。
根据当前触发时刻的状态值和飞艇的姿态动力学模型确定自适应姿态观测器。
根据当前触发时刻的状态值和飞艇的位置动力学模型确定自适应位置观测器。
自适应状态观测器设计:
平流层飞艇的姿态动力学模型为:
其中,Θ=[φ,θ,ψ]T为飞艇的姿态角,Ω=[p,q,r]T为体轴系中的角速度,为执行器饱和造成的输入误差,表示飞艇的姿态角的导数,表示体轴系中的角速度的导数,fω表示姿态动力学中未建模动态和随机扰动。
因此,自适应姿态观测器表示为:
其中,表示飞艇姿态角的观测值的导数,表示飞艇体轴系中的角速度的观测值的导数,H1和H2均表示正定的反馈增益矩阵,和分别表示用来补偿事件触发引起的反馈误差的自适应项,表示上一触发时刻传感器发送到滑模控制器的姿态角,表示上一触发时刻传感器发送到滑模控制器的角速度,表示执行器饱和产生的误差,τω表示姿态控制量,B22表示飞艇的广义转动惯量矩阵的逆矩阵,R表示体轴系中的角速度到地轴系中的角速度的转换矩阵,表示飞艇姿态角的观测值,表示飞艇体轴系中的角速度的观测值,Fω表示广义的合外力矩向量。
平流层飞艇的位置动力学模型为:
自适应位置观测器表示为:
其中,表示飞艇位置的观测值,表示飞艇体轴系中的速度的观测值,表示上一触发时刻传感器发送到滑模控制器的体轴系中的速度,表示上一触发时刻传感器发送到滑模控制器的位置,H3和H4均表示正定的反馈增益矩阵,和分别表示用来补偿事件触发引起的反馈误差的自适应项,K表示体轴系中的速度到地轴系中的速度的转换矩阵,表示飞艇位置的观测值,表示飞艇体轴系中的速度的观测值,B11表示飞艇的广义质量矩阵的逆矩阵。
步骤105:通过自适应状态观测器获取飞艇的状态观测值。
步骤106:将获得的滑模控制量与执行器的执行量进行比较,获得由执行器饱和产生的误差。
步骤107:根据执行器饱和产生的误差确定执行器饱和消除值。
其中,步骤107具体包括:基于辅助设计系统,根据执行器饱和产生的误差确定执行器饱和消除值;
辅助设计系统表示为:
其中,表示第一正定对角常数矩阵,表示第二正定对角常数矩阵,表示位置输入误差和表示姿态输入误差,Bv,0=KB11,Bω,0=RB22,表示表示位置控制饱和消除值,ξω表示姿态控制饱和消除值,表示ξv的导数,表示ξω的导数。
步骤108:基于滑模控制器,根据期望飞行轨迹、期望姿态、当前触发时刻的状态值、当前时刻的状态观测值和执行器饱和消除值获得滑模控制量。
步骤109:将滑模控制量传输至飞艇的动力装置。
具体为:将滑模控制量传输执行机构,执行机构根据滑模控制量对飞艇轨迹进行控制,实现轨迹跟踪控制的功能。
滑模控制量包括位置控制量和姿态控制量:
其中,τω表示姿态控制量,τv表示位置控制量,kv表示正定对角距阵,表示正定对角距阵,s2表示位置动力学模型的滑模面,kω表示正定对角距阵,表示正定对角距阵,s1表示姿态动力模型的滑模面,Fv0表示耦合速度项的广义上的外力向量,Fω0表示耦合角速度项的广义上的外力矩向量,表示期望轨迹的二阶导数,表示期望姿态的二阶导数,表示期望轨迹的一阶导数,表示期望姿态的一阶导数,和均表示正定对角阵。
本发明一种基于事件触发的平流层飞艇轨迹跟踪控制方法,其主要内容及程序是:先给定期望轨迹,并由期望轨迹计算出期望姿态;然后设计事件触发机制,将状态的观测值与上一触发时刻时系统的状态值进行比较,当两者误差达到预先设定的触发条件时,传感器开始工作并将触发时刻的状态传输到控制器,在触发间隔内传感器不工作;以触发时刻传回的飞艇状态作为反馈量设计飞艇的状态观测器,以观测触发间隔内不可测量的状态;利用辅助设计系统消除执行器饱和;最后计算消除期望位置与实际位置、期望姿态与实际姿态之间误差所需的控制量τ。实际应用中,飞艇的位置、姿态、速度等状态量由组合惯导等传感器测量得到,将由该方法计算得到的控制量传输至舵机和推进螺旋桨等执行装置即可使平流层飞艇跟踪期望轨迹,且传感器工作频率大幅下降。
下面详细说明本发明一种基于事件触发的平流层飞艇轨迹跟踪控制方法。
Step1:给定期望跟踪值:给定期望的飞行轨迹;根据期望轨迹计算出期望姿态;将期望轨迹pc=[xc,yc,zc]T和期望姿态Θc=[φc,θc,ψc]T输出给Step5中的滑模控制器。其中,在Step1中的给定期望的飞行轨迹为pc=[xc,yc,zc]T,xc,yc,zc为飞艇期望位置;期望姿态的计算方法为:
Step2:事件触发机制设计:将Step3中采集到的状态的观测值与上一触发时刻时传感器测量的系统的状态值进行比较,当两者误差达到预先设定的触发条件时,传感器开始工作并将触发时刻的状态X(tk)传输到Step5中的滑模控制器和Step3中的自适应状态观测器。触发间隔内传感器不工作。其中,在Step2中的事件触发机制,设计为如下形式:
其中X=[X1,X2]T,X1=[x,y,z,φ,θ,ψ]T,X2=[u,v,w,p,q,r]T分别为飞艇的位置、姿态角、体轴系中的速度、体轴系中的角速度,δ1和δ2为大于零的控制器参数。从上述事件触发机制可以看出,当触发条件被满足时,传感器才会工作,并将触发时刻tk+1的系统状态X(tk)传输至控制器。在触发间隔[tk,tk+1]内,传感器不会工作。
Step3:自适应状态观测器设计:以Step2中传回的触发时刻的状态X(tk)作为反馈量设计飞艇的状态观测器,以观测触发间隔内不可测量的状态。并将状态观测值输出到Step2中的事件触发机制和Step5中的滑模控制器。其中,在Step3中的自适应状态观测器设计如下:
平流层飞艇的姿态动力学模型为:
因此设计自适应姿态观测器如下:
平流层飞艇的位置动力学模型为:
因此设计自适应位置观测器如下:
Step4:利用辅助设计系统消除执行器饱和。将Step5中计算得到的滑模控制量τω和τv与真实的执行器的执行量进行比较,并得到由执行器饱和产生的输入误差和并将执行器饱和误差作为辅助设计系统的输入值;而辅助设计系统的输出值ξv和ξω将被传输到Step5中的滑模控制器以消除执行器饱和。
其中,在Step4中利用的辅助设计系统,其具体形式如下:
Step5:滑模控制器计算:计算消除期望位置与实际位置、期望姿态与实际姿态之间误差所需的控制量τ。从Step1到Step4中传输过来的期望轨迹pc=[xc,yc,zc]T和期望姿态Θc=[φc,θc,ψc]T、触发时刻的状态X(tk)、状态观测值辅助设计系统的输出值ξv和ξω将作为滑模控制器的输入。控制器的输出τ则会被传输到Step4中的辅助设计系统和飞艇的执行机构。
其中,在Step5中的滑模控制器计算,其控制量计算公式如下:
位置控制量如下:
姿态控制量如下:
与现有技术比,本发明的优点是:
本发明能够大幅度降低平流层飞艇的传感器的工作频率,延长其工作寿命。
本发明采用辅助设计系统处理饱和,使执行器饱和问题得到大幅度的改善。
本发明针对非线性模型反步设计,能够保证闭环系统的全局稳定。
在应用过程中,控制工程师可以根据实际要求给定飞艇的期望轨迹,并将由本发明计算得到的控制量直接传输至执行机构实现轨迹跟踪控制的功能。
图2为本发明一种基于事件触发的平流层飞艇轨迹跟踪控制系统结构示意图,如图2所示,一种基于事件触发的平流层飞艇轨迹跟踪控制系统包括:
期望姿态计算模块201,用于根据给定的期望飞行轨迹计算飞艇的期望姿态。
状态值误差获取模块202,用于获取飞艇当前时刻的状态观测值与上一触发时刻传感器采集的状态值的误差,记为状态值误差。
当前触发时刻的状态值获得模块203,用于当状态值误差达到预设值时,触发传感器开始工作并获得当前触发时刻的状态值;两个相邻触发时间间隔内传感器不工作。
自适应状态观测器确定模块204,用于根据当前触发时刻的状态值确定飞艇的自适应状态观测器。
状态观测值获得模块205,用于通过自适应状态观测器获取飞艇的状态观测值。
执行器饱和误差产生模块206,用于将获得的滑模控制量与执行器的执行量进行比较,获得由执行器饱和产生的误差。
执行器饱和消除值确定模块206,用于根据执行器饱和产生的误差确定执行器饱和消除值。
滑模控制量确定模块208,用于基于滑模控制器,根据期望飞行轨迹、期望姿态、当前触发时刻的状态值、当前时刻的状态观测值和执行器饱和消除值获得滑模控制量。
控制模块209,用于将滑模控制量传输至飞艇的动力装置。
自适应状态观测器包括自适应姿态观测器和自适应位置观测器。
根据当前触发时刻的状态值和飞艇的姿态动力学模型确定自适应姿态观测器。
根据当前触发时刻的状态值和飞艇的位置动力学模型确定自适应位置观测器。
本说明书中各个实施例采用递进的方式描述,每个实施例重点说明的都是与其他实施例的不同之处,各个实施例之间相同相似部分互相参见即可。对于实施例公开的系统而言,由于其与实施例公开的方法相对应,所以描述的比较简单,相关之处参见方法部分说明即可。
本文中应用了具体个例对本发明的原理及实施方式进行了阐述,以上实施例的说明只是用于帮助理解本发明的方法及其核心思想;同时,对于本领域的一般技术人员,依据本发明的思想,在具体实施方式及应用范围上均会有改变之处。综上所述,本说明书内容不应理解为对本发明的限制。
Claims (10)
1.一种基于事件触发的平流层飞艇轨迹跟踪控制方法,其特征在于,包括:
根据给定的期望飞行轨迹计算飞艇的期望姿态;
获取飞艇当前时刻的状态观测值与上一触发时刻传感器采集的状态值的误差,记为状态值误差;
当所述状态值误差达到预设值时,触发传感器开始工作并获得当前触发时刻的状态值;两个相邻触发时间间隔内传感器不工作;
根据所述当前触发时刻的状态值确定飞艇的自适应状态观测器;
通过所述自适应状态观测器获取飞艇的状态观测值;
将获得的滑模控制量与执行器的执行量进行比较,获得由所述执行器饱和产生的误差;
根据所述执行器饱和产生的误差确定执行器饱和消除值;
基于滑模控制器,根据所述期望飞行轨迹、所述期望姿态、所述当前触发时刻的状态值、所述当前时刻的状态观测值和所述执行器饱和消除值获得滑模控制量;
将所述滑模控制量传输至所述飞艇的动力装置。
3.根据权利要求1所述的基于事件触发的平流层飞艇轨迹跟踪控制方法,其特征在于,所述传感器采集的状态值包括飞艇的位置、姿态和速度。
4.根据权利要求1所述的基于事件触发的平流层飞艇轨迹跟踪控制方法,其特征在于,所述自适应状态观测器包括自适应姿态观测器和自适应位置观测器;
根据所述当前触发时刻的状态值和飞艇的姿态动力学模型确定自适应姿态观测器;
根据所述当前触发时刻的状态值和飞艇的位置动力学模型确定自适应位置观测器。
5.根据权利要求4所述的基于事件触发的平流层飞艇轨迹跟踪控制方法,其特征在于,所述自适应姿态观测器表示为:
其中,表示飞艇姿态角的观测值的导数,表示飞艇体轴系中的角速度的观测值的导数,H1和H2均表示正定的反馈增益矩阵,和分别表示用来补偿事件触发引起的反馈误差的自适应项,表示上一触发时刻传感器发送到滑模控制器的姿态角,表示上一触发时刻传感器发送到滑模控制器的角速度,表示执行器饱和产生的误差,τω表示姿态控制量,B22表示飞艇的转动惯量矩阵的逆,R表示体轴系中的角速度到地轴系中的角速度的转换矩阵,表示飞艇姿态角的观测值,表示飞艇体轴系中的角速度的观测值,Fω表示合外力矩向量;
9.一种基于事件触发的平流层飞艇轨迹跟踪控制系统,其特征在于,包括:
期望姿态计算模块,用于根据给定的期望飞行轨迹计算飞艇的期望姿态;
状态值误差获取模块,用于获取飞艇当前时刻的状态观测值与上一触发时刻传感器采集的状态值的误差,记为状态值误差;
当前触发时刻的状态值获得模块,用于当所述状态值误差达到预设值时,触发传感器开始工作并获得当前触发时刻的状态值;两个相邻触发时间间隔内传感器不工作;
自适应状态观测器确定模块,用于根据所述当前触发时刻的状态值确定飞艇的自适应状态观测器;
状态观测值获得模块,用于通过所述自适应状态观测器获取飞艇的状态观测值;
执行器饱和误差产生模块,用于将获得的滑模控制量与执行器的执行量进行比较,获得由所述执行器饱和产生的误差;
执行器饱和消除值确定模块,用于根据所述执行器饱和产生的误差确定执行器饱和消除值;
滑模控制量确定模块,用于基于滑模控制器,根据所述期望飞行轨迹、所述期望姿态、所述当前触发时刻的状态值、所述当前时刻的状态观测值和所述执行器饱和消除值获得滑模控制量;
控制模块,用于将所述滑模控制量传输至所述飞艇的动力装置。
10.根据权利要求9所述的基于事件触发的平流层飞艇轨迹跟踪控制系统,其特征在于,所述自适应状态观测器包括自适应姿态观测器和自适应位置观测器;
根据所述当前触发时刻的状态值和飞艇的姿态动力学模型确定自适应姿态观测器;
根据所述当前触发时刻的状态值和飞艇的位置动力学模型确定自适应位置观测器。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110834786.7A CN113419431B (zh) | 2021-07-23 | 2021-07-23 | 一种基于事件触发的平流层飞艇轨迹跟踪控制方法及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110834786.7A CN113419431B (zh) | 2021-07-23 | 2021-07-23 | 一种基于事件触发的平流层飞艇轨迹跟踪控制方法及系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113419431A true CN113419431A (zh) | 2021-09-21 |
CN113419431B CN113419431B (zh) | 2022-06-21 |
Family
ID=77718253
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110834786.7A Active CN113419431B (zh) | 2021-07-23 | 2021-07-23 | 一种基于事件触发的平流层飞艇轨迹跟踪控制方法及系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113419431B (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114253133A (zh) * | 2021-12-07 | 2022-03-29 | 北京科技大学 | 基于动态事件触发机制的滑模容错控制方法及装置 |
CN114326393A (zh) * | 2021-12-16 | 2022-04-12 | 安徽大学 | 非完整小车轨迹跟踪控制方法及装置 |
CN118311981A (zh) * | 2024-06-07 | 2024-07-09 | 西北工业大学 | 一种基于事件触发的飞行器集群姿态协同抗饱和控制方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105116914A (zh) * | 2015-09-01 | 2015-12-02 | 北京天航华创科技股份有限公司 | 一种平流层飞艇解析模型预测路径跟踪控制方法 |
US20170315545A1 (en) * | 2016-04-29 | 2017-11-02 | Shenzhen Hubsan Technology Co., Ltd. | Method for recording flight path and controlling automatic flight of unmanned aerial vehicle |
CN110456821A (zh) * | 2019-08-22 | 2019-11-15 | 安徽大学 | 基于动态触发机制的飞行器轨迹最优控制方法和系统 |
CN111413996A (zh) * | 2020-04-09 | 2020-07-14 | 中北大学 | 一种基于事件触发eso的四旋翼保性能轨迹跟踪控制方法 |
CN112180961A (zh) * | 2020-09-30 | 2021-01-05 | 北京航空航天大学 | 一种全状态受限平流层飞艇轨迹跟踪控制方法及系统 |
CN112578804A (zh) * | 2020-12-16 | 2021-03-30 | 南京理工大学 | 一种基于事件触发机制的四旋翼飞行器编队滑模控制方法 |
-
2021
- 2021-07-23 CN CN202110834786.7A patent/CN113419431B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105116914A (zh) * | 2015-09-01 | 2015-12-02 | 北京天航华创科技股份有限公司 | 一种平流层飞艇解析模型预测路径跟踪控制方法 |
US20170315545A1 (en) * | 2016-04-29 | 2017-11-02 | Shenzhen Hubsan Technology Co., Ltd. | Method for recording flight path and controlling automatic flight of unmanned aerial vehicle |
CN110456821A (zh) * | 2019-08-22 | 2019-11-15 | 安徽大学 | 基于动态触发机制的飞行器轨迹最优控制方法和系统 |
CN111413996A (zh) * | 2020-04-09 | 2020-07-14 | 中北大学 | 一种基于事件触发eso的四旋翼保性能轨迹跟踪控制方法 |
CN112180961A (zh) * | 2020-09-30 | 2021-01-05 | 北京航空航天大学 | 一种全状态受限平流层飞艇轨迹跟踪控制方法及系统 |
CN112578804A (zh) * | 2020-12-16 | 2021-03-30 | 南京理工大学 | 一种基于事件触发机制的四旋翼飞行器编队滑模控制方法 |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114253133A (zh) * | 2021-12-07 | 2022-03-29 | 北京科技大学 | 基于动态事件触发机制的滑模容错控制方法及装置 |
CN114253133B (zh) * | 2021-12-07 | 2023-09-01 | 北京科技大学 | 基于动态事件触发机制的滑模容错控制方法及装置 |
CN114326393A (zh) * | 2021-12-16 | 2022-04-12 | 安徽大学 | 非完整小车轨迹跟踪控制方法及装置 |
CN114326393B (zh) * | 2021-12-16 | 2024-03-12 | 安徽大学 | 非完整小车轨迹跟踪控制方法及装置 |
CN118311981A (zh) * | 2024-06-07 | 2024-07-09 | 西北工业大学 | 一种基于事件触发的飞行器集群姿态协同抗饱和控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN113419431B (zh) | 2022-06-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113419431B (zh) | 一种基于事件触发的平流层飞艇轨迹跟踪控制方法及系统 | |
CN108614426B (zh) | 一种基于干扰观测器的多移动机器人编队鲁棒控制方法 | |
Menon et al. | Integrated guidance and control of moving-mass actuated kinetic warheads | |
CN110119089B (zh) | 一种基于积分滑模的浸入不变流型自适应四旋翼控制方法 | |
CN108873929B (zh) | 一种固定翼飞机自主着舰方法及系统 | |
CN108363305A (zh) | 基于主动干扰补偿的战术导弹鲁棒过载自驾仪设计方法 | |
CN107783422B (zh) | 采用捷联惯导的火炮瞄准稳定系统控制方法 | |
CN111506099B (zh) | 一种无人机高度智能控制系统及方法 | |
CN112486193B (zh) | 一种基于自适应增广控制理论的飞翼无人机三轴全权限控制方法 | |
CN112558621A (zh) | 一种基于解耦控制的飞行机械臂系统 | |
CN111290278B (zh) | 一种基于预测滑模的高超声速飞行器鲁棒姿态控制方法 | |
CN112180965A (zh) | 一种高精度过载控制方法 | |
CN112180961B (zh) | 一种全状态受限平流层飞艇轨迹跟踪控制方法及系统 | |
CN109582039A (zh) | 一种采用相对导航信息的j2摄动下最优队形重构方法 | |
CN117389312A (zh) | 一种基于模型的水下航行器抗衡滚三维跟踪控制方法 | |
KR20140094313A (ko) | 마찰력 보상기 및 이를 이용한 마찰력 보상방법 | |
JP4617990B2 (ja) | 自動飛行制御装置、自動飛行制御方法及び自動飛行制御プログラム | |
Wang et al. | Non-cascaded dynamic inversion design for quadrotor position control with L1 augmentation | |
CN107450313A (zh) | 基于自适应控制的无人机自动驾驶仪控制系统 | |
CN111413996B (zh) | 一种基于事件触发eso的四旋翼保性能轨迹跟踪控制方法 | |
Bogdanov et al. | SDRE control with nonlinear feedforward compensation for a small unmanned helicopter | |
CN116301058B (zh) | 一种无人飞行反馈非线性偏航控制方法、系统和设备 | |
CN116382332B (zh) | 一种基于ude的战斗机大机动鲁棒飞行控制方法 | |
CN115755590B (zh) | 一种高超声速飞行器抗扰制导控制系统及方法 | |
CN110647161A (zh) | 基于状态预测补偿的欠驱动uuv水平面轨迹跟踪控制方法 |
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 |