CN107315419A - 一种实现飞艇远距离定点悬停的三段式控制策略 - Google Patents
一种实现飞艇远距离定点悬停的三段式控制策略 Download PDFInfo
- Publication number
- CN107315419A CN107315419A CN201710402531.7A CN201710402531A CN107315419A CN 107315419 A CN107315419 A CN 107315419A CN 201710402531 A CN201710402531 A CN 201710402531A CN 107315419 A CN107315419 A CN 107315419A
- Authority
- CN
- China
- Prior art keywords
- msub
- mrow
- mtr
- mtd
- dirigible
- 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
- 238000011217 control strategy Methods 0.000 title claims abstract description 9
- 238000013461 design Methods 0.000 claims abstract description 13
- 238000005259 measurement Methods 0.000 claims abstract description 4
- 239000011159 matrix material Substances 0.000 claims description 9
- 238000000034 method Methods 0.000 claims description 8
- 230000001133 acceleration Effects 0.000 claims description 7
- 230000010354 integration Effects 0.000 claims description 6
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 claims description 4
- 238000000205 computational method Methods 0.000 claims description 3
- 239000013641 positive control Substances 0.000 claims description 3
- 230000009286 beneficial effect Effects 0.000 abstract description 2
- 230000000694 effects Effects 0.000 description 4
- 230000006641 stabilisation Effects 0.000 description 3
- 238000011105 stabilization Methods 0.000 description 3
- 238000004458 analytical method Methods 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 238000004088 simulation Methods 0.000 description 2
- 238000012360 testing method Methods 0.000 description 2
- 241000208340 Araliaceae Species 0.000 description 1
- 240000007594 Oryza sativa Species 0.000 description 1
- 235000007164 Oryza sativa Nutrition 0.000 description 1
- 235000005035 Panax pseudoginseng ssp. pseudoginseng Nutrition 0.000 description 1
- 235000003140 Panax quinquefolius Nutrition 0.000 description 1
- 230000003139 buffering effect Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 230000009194 climbing Effects 0.000 description 1
- 238000005094 computer simulation Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 235000008434 ginseng Nutrition 0.000 description 1
- 235000009566 rice Nutrition 0.000 description 1
- 239000005437 stratosphere Substances 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous 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
本发明公开了一种实现飞艇远距离定点悬停的三段式控制策略,根据初始远距离,设置减速开始距离与悬停开始距离;测量飞艇实时飞行位置,并与目标悬停位置进行比较,并作出控制模式选择判断;设定飞艇匀速飞行的期望速度为ud,测量飞艇的实际前向飞行速度为u,则速度误差记为eu,进行匀速飞行段飞艇前向速度跟踪控制律设计;选定悬停开始段的期望速度,进行减速段控制;测量飞艇的位置信息、前向速度信息,进行小距离的精确定点悬停控制;建立飞艇俯仰通道模型,通过仿真来调选控制参数。发明的有益效果是提高了远距离情况下末段定点悬停的动态与稳态性能。
Description
技术领域
本发明属于飞行器控制领域,涉及一种实现飞艇远距离定点悬停的三段式控制策略。
背景技术
由于平流层有着稳定的气象条件和良好的电磁特性,平流层飞艇的应用价值和广阔应用前景引起了世界各国的重视,越来越多的文献进行了相关的报道。在现有的公开文献中,关于飞艇飞行控制系统的资料较少,大多是关于飞艇设计和稳定性分析。目前关于飞艇悬停控制的研究比较多的多是关于近距离的飞艇悬停控制,重点在于悬停的准确性与快速性。但已公开的远距离定点悬停的研究成果较少,主要是远距离的定点悬停控制和近距离的定点悬停控制有本质的区别。因为近距离定点悬停可以采用位置误差的PID控制得以实现,而初始点距目标悬停点较近,因此采用一套参数即可获得满意的控制效果。而远距离的定点悬停由于初始位置离目标悬停点较远,难以通过位置PID控制而实现。
发明内容
本发明的目的在于提供一种实现飞艇远距离定点悬停的三段式控制策略,解决了目前定点悬停由于初始位置离目标悬停点较远,难以通过位置PID控制而实现的问题。
本发明所采用的技术方案是按照以下步骤进行:
步骤一:根据初始远距离,设置减速开始距离与悬停开始距离;
假设初始时刻飞艇距离目标定点悬停位置为d0,则设定减速开始距离为l,设定悬停开始距离为m;
步骤二:测量飞艇实时飞行位置,并与目标悬停位置进行比较,并作出控制模式选择判断;
测量飞艇的实时飞行位置,记为x,而期望的远距离定点悬停位置记为xd,则两种之间的距离记为d=|x-xd|;
如果l<d<d0,则进入第一段匀速飞行控制段;
如果m<d≤l,则进入第二段减速飞行控制段;
如果0<d≤m,则进入第三段定点悬停控制段;
步骤三:设定飞艇匀速飞行的期望速度为ud,测量飞艇的实际前向飞行速度为u,则速度误差记为eu,进行匀速飞行段飞艇前向速度跟踪控制律设计;
步骤四:速度控制;选定悬停开始段的期望速度,进行减速段控制;
首先记录减速段开始的时间,记为t1;其次设定悬停开始段的期望速度为udb,然后设定减速持续时间为ta,按照如下公式选取:
ta=2(l-m)/(uda+udb)
最后设定期望速度vd=uda-(uda-udb)(t-t1)/ta,并以该速度为期望速度,输入给步骤三设计的匀速飞行段飞艇前向速度跟踪控制律;
步骤五:位置控制;测量飞艇的位置信息、前向速度信息,进行小距离的精确定点悬停控制;
其中u2表示前向飞行的发动机输入参数,以控制飞艇的前向运动动力,ex=x-xd,其中x为惯性导航器件测量所得的飞艇实时位置,而xd为飞艇的期望定点悬停位置,其中u为飞艇前向飞行速度,其可由惯性导航器件测量而得,∫exdt为误差的积分,可有位置误差信号经过艇上计算机积分而得到,ka1、ka2、ka3、ε为正的控制参数;
步骤六:建立飞艇俯仰通道模型,通过仿真来调选控制参数;
其中
而a11,a13,a22,a31,a33由计算M矩阵的逆阵而获得,即满足
M矩阵由飞艇的质量与转动惯量所决定,其求取方法如下:
I3为3阶单位矩阵;
其中m为飞艇的质量,az为常量,m11、m33、m55由飞艇质量分布与转动惯量所决定:m11=km1Mr,m33=km2Mr,m55=km3Iy,其中km1=0.1053;km2=0.8260;km3=0.1256;Mr=ρV,其中ρ为大气密度,V为飞艇的体积;Q为动压头,其计算方法为Q=0.5ρVf 2;Vf为飞艇的运动速度;为飞艇的前向飞行加速度;u为艇体坐标系中飞艇的前向飞行速度;为飞艇的垂向飞行加速度;w为艇体坐标系中飞艇的垂向飞行速度;为飞艇的俯仰角加速度;q为飞艇的俯仰角速度;为飞艇的俯仰角速度,θ为飞艇的俯仰角;为发射坐标系中飞艇的前向飞行速度;x为飞艇的前向飞行距离;为发射坐标系中飞艇的垂向飞行速度;z为飞艇的飞行高度;
kg1与kg2为舵效常数;CX1、CX2、Cz1、Cz2与Cz3为飞艇受力相关的空气动力系数,CM1、CM2、CM1为飞艇受力矩相关的空气动力系数;
发明的有益效果是提高了远距离情况下末段定点悬停的动态与稳态性能。该设计物理意义明确,能很好地解决远距离定点悬停的飞艇速度分配与规划问题,因此具有很高的工程实用价值。
附图说明
图1是本发明提供的一种实现飞艇远距离定点悬停的三段式控制策略原理流程图;
图2是本发明实施例提供的8000米远距离定点悬停情况下的飞艇的前向运动速度曲线;
图3是本发明实施例提供的8000米远距离定点悬停情况下的飞艇的垂向运动速度曲线;
图4是本发明实施例提供的8000米远距离定点悬停情况下的给定0度俯仰角指令情况下的飞艇俯仰角小幅波动曲线;
图5是本发明实施例提供的8000米远距离定点悬停情况下的飞艇的俯仰角速率曲线;
图6是本发明实施例提供的8000米远距离定点悬停情况下的飞艇的水平飞行距离曲线;
图7为本发明实施例提供的8000米远距离定点悬停情况下的飞艇的飞行高度曲线;
图8为本发明实施例提供的8000米远距离定点悬停情况下的飞艇的推力曲线;
图9是本发明实施例提供的8000米远距离定点悬停情况下的飞艇的前向运动速度期望值曲线。
具体实施方式
下面结合具体实施方式对本发明进行详细说明。
本发明实施例的目的在于提供一种实现飞艇远距离定点悬停的三段式控制策略,该方法的特点是通过分三段过渡来实现飞艇执行远距离定点悬停任务。其中第一段为从出发到加速并匀速飞行到远距离的任务点附近,该段为匀速跟踪段,第二段为减速以为定点悬停做好准备,该段为减速段,第三段为定点悬停段,实现到达任务点的精确定点悬停功能。本发明包括如下七步:
步骤一:根据初始远距离,设置减速开始距离与悬停开始距离;
假设初始时刻飞艇距离目标定点悬停位置为d0,则设定减速开始距离为l,显然l<d0,设定悬停开始距离为m,显然m<l。
步骤二:测量飞艇实时飞行位置,并与目标悬停位置进行比较,并作出控制模式选择判断;
采用惯性导航组合,测量飞艇的实时飞行位置,记为x,而期望的远距离定点悬停位置记为xd,则两种之间的距离记为d=|x-xd|。
如果l<d<d0,则进入第一段匀速飞行控制段;
如果m<d≤l,则进入第二段减速飞行控制段;
如果0<d≤m,则进入第三段定点悬停控制段;
步骤三:选定匀速飞行速度,并进行匀速飞行段飞艇前向速度跟踪控制律设计;
设定飞艇匀速飞行的期望速度为ud,测量飞艇的实际前向飞行速度为u,则速度误差记为eu,此时可采用误差信号的PID控制律或其它控制律实现对给定速度信号的跟踪控制。
步骤四:选定悬停开始段的期望速度,进行减速段控制;
首先记录减速段开始的时间,记为t1;
其次设定悬停开始段的期望速度为udb,显然udb<uda;
然后设定减速持续时间为ta,可以按照如下公式选取:
ta=2(l-m)/(uda+udb)
最后设定期望速度vd=uda-(uda-udb)(t-t1)/ta,并以该速度为期望速度,输入给步骤三设计的匀速飞行段飞艇前向速度跟踪控制律,所不同的是步骤三中期望速度为常值,而步骤四中期望速度为匀速减小的变量。
步骤五:测量飞艇的位置信息、前向速度信息,进行小距离的精确定点悬停控制;
经过前面的步骤一至步骤四后,飞艇已经飞行到定点悬停位置附近较小的范围内,而且经过减速段的缓冲,飞艇的飞行速度已经接近于0,那么采用常规的PID控制或者其它控制方法,即可实现小距离的精确定点悬停。下面仅以一类非线性改进PID控制方法为例示意,使得整个远距离定点悬停得以完整展示。
其中u2表示前向飞行的发动机输入,以控制飞艇的前向运动动力。
ex=x-xd,其中x为惯性导航器件测量所得的飞艇实时位置,而xd为飞艇的期望定点悬停位置。
其中u为飞艇前向飞行速度,其可由惯性导航器件测量而得。∫exdt为误差的积分,可有位置误差信号经过艇上计算机积分而得到。
ka1、ka2、ka3、ε为正的控制参数,该参数需要在建立步骤六的近似模型中调试得到,可见经过多次参数调试,选取合适值以得到满意的悬停控制效果。
步骤六:根据如下飞艇俯仰通道的微分方程所建立的数学模型,近似模拟飞艇俯仰通道的特性,从而进行参数调整达到最优。其中飞艇俯仰通道的模型如下:
其中
而a11,a13,a22,a31,a33由计算M矩阵的逆阵而获得,即满足
而M矩阵由飞艇的质量与转动惯量所决定,其求取方法如下:
I3为3阶单位矩阵。
其中m为飞艇的质量,az为常量,如某型飞艇可选为m=53345;az=16.8,m11、m33、m55由飞艇质量分布与转动惯量所决定:m11=km1Mr,m33=km2Mr,m55=km3Iy,其中km1=0.1053;km2=0.8260;km3=0.1256。如某型飞艇参数设计为Iy=5.9*109,以上单位均为国际标准单位。Mr=ρV,其中ρ为大气密度,V为飞艇的体积。
Q为动压头,其计算方法为Q=0.5ρVf 2;Vf为飞艇的运动速度。
为飞艇的前向飞行加速度;u为艇体坐标系中飞艇的前向飞行速度;
为飞艇的垂向飞行加速度;w为艇体坐标系中飞艇的垂向飞行速度;
为飞艇的俯仰角加速度;q为飞艇的俯仰角速度;
为飞艇的俯仰角速度,θ为飞艇的俯仰角;
为发射坐标系中飞艇的前向飞行速度;x为飞艇的前向飞行距离;
为发射坐标系中飞艇的垂向飞行速度;z为飞艇的飞行高度;
kg1与kg2为舵效常数,为空气动力学系数,其数据来自于飞艇风洞试验。
CX1、CX2、Cz1、Cz2与Cz3为飞艇受力相关的空气动力系数,CM1、CM2、CM1为飞艇受力矩相关的空气动力系数,各型飞艇的计算方式略有不同,其数据来自于飞艇的风洞实验数据,非本发明所保护与所讨论的内容,故不详细累述。
针对上述复杂模型的分析,可以简化为如下一阶模型:
飞艇前向控制器的设计是通过设计u2来控制飞艇的前向运动速度u,使其跟踪给定的飞行速度,或者通过前向运动速度,进一步实现定点悬停位置的精确控制。在本发明中,第一段匀速飞行段与第二段减速飞行段,均是为了实现速度的跟踪控制,而第三段的定点悬停段,则是为了实现飞行距离的精确控制。此时系统模型可简化为如下二阶系统:
此时θ接近于0。说明:姿态稳定是实现近距离或远距离定点悬停的基础,因此在本案例中,我们假使定点悬停的同时,飞艇不进行高度的爬升运动,因此将其姿态角稳定在0度附近。
步骤一至步骤五所得的控制量代入步骤六所建立的模型,通过不断调整控制参数,并观察飞艇各状态的数据并画图,尤其是观测飞艇横向飞行速度以及飞行距离的数据曲线,分析远距离定点悬停的响应效果以及飞艇速度是否按照预订的速度分配运行,从而最终确定一组飞艇远距离定点悬停的控制方案参数,使得飞艇的远距离定点悬停具有满意的动态响应与稳态响应性能。
本发明提出三段式的控制策略,将原距离定点悬停分为匀速飞行段、减速缓冲段、定点悬停段,最终经过减速缓冲后进入末段定点悬停的精确控制,大大提高了远距离情况下末段定点悬停的动态与稳态性能。该设计物理意义明确,能很好地解决远距离定点悬停的飞艇速度分配与规划问题,因此具有很高的工程实用价值。
案例实施与计算机仿真模拟结果分析
首先采用PID控制规律,设定飞艇的俯仰角稳定控制器,悬停时选取飞艇的期望俯仰角为0度。实际俯仰角会在0度附近波动,最后稳定在0度左右,见附图4。
在上述姿态稳定的基础上,设定飞艇初始高度为10000米,初始速度为0m/s,假设定点悬停距离为8000米,飞艇先以20米每秒的速度进行飞行,当接近悬停点1000米区域开始,飞艇进行减速至3米每秒的速度进行飞行,减速过程大约为60秒,飞行距离大约为600米。最近接近目标100米时,采用近距离定点悬停方案设计。
则按照上述步骤一至步骤六,选取方案参数为假设初始时刻飞艇距离目标定点悬停位置为d0=8000,则设定减速开始距离为l=1000,显然l<d0,设定悬停开始距离为m=100,显然m<l。
设定飞艇匀速飞行的期望速度为ud=20,首先记录减速段开始的时间,记为t1=400;其次设定悬停开始段的期望速度为udb=3,显然udb<uda;然后设定减速持续时间为ta,ta=2(l-m)/(uda+udb)=1800/23=78.2s,最后设定期望速度通过以上设定后进行飞艇的远距离定点悬停控制,得到的结果如图2至图8所示。
通过以上仿真结果与曲线可以看出,定点悬停阶段,俯仰角能够稳定在0附近,有波动但周期比较长,频率比较低,符合飞艇的运动特点与物理特性。而由期望的前向飞行速度曲线图9可以看出本发明所提出的三段式控制策略对飞艇速度分配与控制非常合理,由于经过减速缓冲,大大减轻了末端定点悬停的控制设计难度,同时也获得了较好的悬停控制效果,而且该控制方案很容易推广到其它不同距离的悬停控制中,因此本发明具有较高的工程应用价值。
Claims (1)
1.一种实现飞艇远距离定点悬停的三段式控制策略,其特征在于按照以下步骤进行:
步骤一:根据初始远距离,设置减速开始距离与悬停开始距离;
假设初始时刻飞艇距离目标定点悬停位置为d0,则设定减速开始距离为l,设定悬停开始距离为m;
步骤二:测量飞艇实时飞行位置,并与目标悬停位置进行比较,并作出控制模式选择判断;
测量飞艇的实时飞行位置,记为x,而期望的远距离定点悬停位置记为xd,则两种之间的距离记为d=|x-xd|;
如果l<d<d0,则进入第一段匀速飞行控制段;
如果m<d≤l,则进入第二段减速飞行控制段;
如果0<d≤m,则进入第三段定点悬停控制段;
步骤三:设定飞艇匀速飞行的期望速度为ud,测量飞艇的实际前向飞行速度为u,则速度误差记为eu,进行匀速飞行段飞艇前向速度跟踪控制律设计;
步骤四:速度控制;选定悬停开始段的期望速度,进行减速段控制;
首先记录减速段开始的时间,记为t1;其次设定悬停开始段的期望速度为udb,然后设定减速持续时间为ta,按照如下公式选取:
ta=2(l-m)/(uda+udb)
最后设定期望速度vd=uda-(uda-udb)(t-t1)/ta,并以该速度为期望速度,输入给步骤三设计的匀速飞行段飞艇前向速度跟踪控制律;
步骤五:位置控制;测量飞艇的位置信息、前向速度信息,进行小距离的精确定点悬停控制;
<mrow>
<msub>
<mi>u</mi>
<mn>2</mn>
</msub>
<mo>=</mo>
<mo>-</mo>
<msub>
<mi>k</mi>
<mrow>
<mi>a</mi>
<mn>1</mn>
</mrow>
</msub>
<msub>
<mi>e</mi>
<mi>x</mi>
</msub>
<mo>-</mo>
<msub>
<mi>k</mi>
<mrow>
<mi>a</mi>
<mn>2</mn>
</mrow>
</msub>
<mo>&Integral;</mo>
<msub>
<mi>e</mi>
<mi>x</mi>
</msub>
<mi>d</mi>
<mi>t</mi>
<mo>-</mo>
<msub>
<mi>k</mi>
<mrow>
<mi>a</mi>
<mn>3</mn>
</mrow>
</msub>
<msub>
<mover>
<mi>e</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>x</mi>
</msub>
<mo>-</mo>
<msub>
<mi>k</mi>
<mrow>
<mi>a</mi>
<mn>4</mn>
</mrow>
</msub>
<mfrac>
<msub>
<mi>e</mi>
<mi>x</mi>
</msub>
<mrow>
<msubsup>
<mi>e</mi>
<mi>x</mi>
<mrow>
<mn>2</mn>
<mo>/</mo>
<mn>3</mn>
</mrow>
</msubsup>
<mo>+</mo>
<mi>&epsiv;</mi>
</mrow>
</mfrac>
</mrow>
其中u2表示前向飞行的发动机输入参数,以控制飞艇的前向运动动力,
ex=x-xd,其中x为惯性导航器件测量所得的飞艇实时位置,而xd为飞艇的期望定点悬停位置,其中u为飞艇前向飞行速度,其可由惯性导航器件测量而得,∫exdt为误差的积分,可有位置误差信号经过艇上计算机积分而得到,ka1、ka2、ka3、ε为正的控制参数;
步骤六:建立飞艇俯仰通道模型,通过仿真来调选控制参数;
<mrow>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mover>
<mi>u</mi>
<mo>&CenterDot;</mo>
</mover>
</mtd>
</mtr>
<mtr>
<mtd>
<mover>
<mi>w</mi>
<mo>&CenterDot;</mo>
</mover>
</mtd>
</mtr>
<mtr>
<mtd>
<mover>
<mi>q</mi>
<mo>&CenterDot;</mo>
</mover>
</mtd>
</mtr>
<mtr>
<mtd>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
</mtd>
</mtr>
<mtr>
<mtd>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
</mtd>
</mtr>
<mtr>
<mtd>
<mover>
<mi>z</mi>
<mo>&CenterDot;</mo>
</mover>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>a</mi>
<mn>11</mn>
</msub>
<msub>
<mi>f</mi>
<mn>1</mn>
</msub>
<mo>+</mo>
<msub>
<mi>a</mi>
<mn>13</mn>
</msub>
<msub>
<mi>f</mi>
<mn>3</mn>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>a</mi>
<mn>22</mn>
</msub>
<msub>
<mi>f</mi>
<mn>2</mn>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>a</mi>
<mn>31</mn>
</msub>
<msub>
<mi>f</mi>
<mn>1</mn>
</msub>
<mo>+</mo>
<msub>
<mi>a</mi>
<mn>33</mn>
</msub>
<msub>
<mi>f</mi>
<mn>3</mn>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>f</mi>
<mn>4</mn>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>f</mi>
<mn>5</mn>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>f</mi>
<mn>6</mn>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>+</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>a</mi>
<mn>11</mn>
</msub>
<msub>
<mi>u</mi>
<mn>2</mn>
</msub>
<mo>+</mo>
<msub>
<mi>a</mi>
<mn>13</mn>
</msub>
<msub>
<mi>k</mi>
<mrow>
<mi>g</mi>
<mn>2</mn>
</mrow>
</msub>
<msub>
<mi>u</mi>
<mn>1</mn>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>a</mi>
<mn>22</mn>
</msub>
<msub>
<mi>k</mi>
<mrow>
<mi>g</mi>
<mn>1</mn>
</mrow>
</msub>
<msub>
<mi>u</mi>
<mn>1</mn>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>a</mi>
<mn>31</mn>
</msub>
<msub>
<mi>u</mi>
<mn>2</mn>
</msub>
<mo>+</mo>
<msub>
<mi>a</mi>
<mn>33</mn>
</msub>
<msub>
<mi>k</mi>
<mrow>
<mi>g</mi>
<mn>2</mn>
</mrow>
</msub>
<msub>
<mi>u</mi>
<mn>1</mn>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
其中
<mrow>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>f</mi>
<mn>1</mn>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>f</mi>
<mn>2</mn>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>f</mi>
<mn>3</mn>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>f</mi>
<mn>4</mn>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>f</mi>
<mn>5</mn>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>f</mi>
<mn>6</mn>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mi>m</mi>
<mo>+</mo>
<msub>
<mi>m</mi>
<mn>33</mn>
</msub>
<mo>)</mo>
</mrow>
<mi>w</mi>
<mi>q</mi>
<mo>+</mo>
<mi>Q</mi>
<mo>&lsqb;</mo>
<msub>
<mi>C</mi>
<mrow>
<mi>X</mi>
<mn>1</mn>
</mrow>
</msub>
<msup>
<mi>cos</mi>
<mn>2</mn>
</msup>
<mo>+</mo>
<mi>&alpha;</mi>
<mo>+</mo>
<msub>
<mi>C</mi>
<mrow>
<mi>X</mi>
<mn>2</mn>
</mrow>
</msub>
<mi>sin</mi>
<mrow>
<mo>(</mo>
<mn>2</mn>
<mi>&alpha;</mi>
<mo>)</mo>
</mrow>
<mi>sin</mi>
<mrow>
<mo>(</mo>
<mi>&alpha;</mi>
<mo>/</mo>
<mn>2</mn>
<mo>)</mo>
</mrow>
<mo>&rsqb;</mo>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>(</mo>
<mi>m</mi>
<mo>+</mo>
<msub>
<mi>m</mi>
<mn>11</mn>
</msub>
<mo>)</mo>
<mi>q</mi>
<mi>u</mi>
<mo>+</mo>
<msub>
<mi>ma</mi>
<mi>z</mi>
</msub>
<msup>
<mi>q</mi>
<mn>2</mn>
</msup>
<mo>+</mo>
<mi>Q</mi>
<mo>&lsqb;</mo>
<msub>
<mi>C</mi>
<mrow>
<mi>z</mi>
<mn>1</mn>
</mrow>
</msub>
<mi>cos</mi>
<mo>(</mo>
<mi>&alpha;</mi>
<mo>/</mo>
<mn>2</mn>
<mo>)</mo>
<mi>sin</mi>
<mo>(</mo>
<mn>2</mn>
<mi>&alpha;</mi>
<mo>)</mo>
<mo>+</mo>
<msub>
<mi>C</mi>
<mrow>
<mi>z</mi>
<mn>2</mn>
</mrow>
</msub>
<mi>sin</mi>
<mo>(</mo>
<mn>2</mn>
<mi>&alpha;</mi>
<mo>)</mo>
<mo>+</mo>
<msub>
<mi>C</mi>
<mrow>
<mi>z</mi>
<mn>3</mn>
</mrow>
</msub>
<mi>sin</mi>
<mo>(</mo>
<mi>&alpha;</mi>
<mo>)</mo>
<mi>sin</mi>
<mo>(</mo>
<mo>|</mo>
<mi>&alpha;</mi>
<mo>|</mo>
<mo>)</mo>
<mo>&rsqb;</mo>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>Q</mi>
<mo>&lsqb;</mo>
<msub>
<mi>C</mi>
<mrow>
<mi>M</mi>
<mn>1</mn>
</mrow>
</msub>
<mi>cos</mi>
<mrow>
<mo>(</mo>
<mi>&alpha;</mi>
<mo>/</mo>
<mn>2</mn>
<mo>)</mo>
</mrow>
<mi>sin</mi>
<mrow>
<mo>(</mo>
<mn>2</mn>
<mi>&alpha;</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>C</mi>
<mrow>
<mi>M</mi>
<mn>2</mn>
</mrow>
</msub>
<mi>sin</mi>
<mrow>
<mo>(</mo>
<mn>2</mn>
<mi>&alpha;</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>C</mi>
<mrow>
<mi>M</mi>
<mn>3</mn>
</mrow>
</msub>
<mi>sin</mi>
<mrow>
<mo>(</mo>
<mi>&alpha;</mi>
<mo>)</mo>
</mrow>
<mi>sin</mi>
<mrow>
<mo>(</mo>
<mo>|</mo>
<mi>&alpha;</mi>
<mo>|</mo>
<mo>)</mo>
</mrow>
<mo>&rsqb;</mo>
<mo>-</mo>
<msub>
<mi>a</mi>
<mi>z</mi>
</msub>
<mi>w</mi>
<mi>sin</mi>
<mi>&theta;</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mi>q</mi>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>u</mi>
<mi>cos</mi>
<mi>&theta;</mi>
<mo>+</mo>
<mi>w</mi>
<mi>sin</mi>
<mi>&theta;</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mi>u</mi>
<mi>sin</mi>
<mi>&theta;</mi>
<mo>+</mo>
<mi>w</mi>
<mi>cos</mi>
<mi>&theta;</mi>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
而a11,a13,a22,a31,a33由计算M矩阵的逆阵而获得,即满足
M矩阵由飞艇的质量与转动惯量所决定,其求取方法如下:
I3为3阶单位矩阵;
其中m为飞艇的质量,az为常量,m11、m33、m55由飞艇质量分布与转动惯量所决定:m11=km1Mr,m33=km2Mr,m55=km3Iy,其中km1=0.1053;km2=0.8260;km3=0.1256;Mr=ρV,其中ρ为大气密度,V为飞艇的体积;Q为动压头,其计算方法为Q=0.5ρVf 2;Vf为飞艇的运动速度;为飞艇的前向飞行加速度;u为艇体坐标系中飞艇的前向飞行速度;为飞艇的垂向飞行加速度;w为艇体坐标系中飞艇的垂向飞行速度;为飞艇的俯仰角加速度;q为飞艇的俯仰角速度;为飞艇的俯仰角速度,θ为飞艇的俯仰角;为发射坐标系中飞艇的前向飞行速度;x为飞艇的前向飞行距离;为发射坐标系中飞艇的垂向飞行速度;z为飞艇的飞行高度;
kg1与kg2为舵效常数;CX1、CX2、Cz1、Cz2与Cz3为飞艇受力相关的空气动力系数,CM1、CM2、CM1为飞艇受力矩相关的空气动力系数。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710402531.7A CN107315419B (zh) | 2017-06-01 | 2017-06-01 | 一种实现飞艇远距离定点悬停的三段式控制策略 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710402531.7A CN107315419B (zh) | 2017-06-01 | 2017-06-01 | 一种实现飞艇远距离定点悬停的三段式控制策略 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107315419A true CN107315419A (zh) | 2017-11-03 |
CN107315419B CN107315419B (zh) | 2020-09-29 |
Family
ID=60182290
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710402531.7A Active CN107315419B (zh) | 2017-06-01 | 2017-06-01 | 一种实现飞艇远距离定点悬停的三段式控制策略 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107315419B (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107807666A (zh) * | 2017-11-29 | 2018-03-16 | 天津聚飞创新科技有限公司 | 飞行器、飞行控制方法及装置 |
CN108693883A (zh) * | 2018-06-06 | 2018-10-23 | 西安智加科技有限公司 | 一种车辆自动驾驶的高精度停车方法和系统 |
CN111752278A (zh) * | 2020-06-30 | 2020-10-09 | 珠海云洲智能科技有限公司 | 航行设备的定点控制方法、装置及电子设备 |
WO2024003549A1 (en) * | 2022-06-28 | 2024-01-04 | Avealto Ltd | A lighter than air vehicle and a communication system comprising the same |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104656657A (zh) * | 2014-12-30 | 2015-05-27 | 南京航空航天大学 | 一种常值风干扰平流层飞艇定点控制方法 |
CN104793498A (zh) * | 2015-05-04 | 2015-07-22 | 中国人民解放军国防科学技术大学 | 一种自主飞艇定点驻留控制方法 |
CN106774385A (zh) * | 2016-12-05 | 2017-05-31 | 烟台南山学院 | 一种采用自适应变结构的飞艇定点悬停控制方法 |
-
2017
- 2017-06-01 CN CN201710402531.7A patent/CN107315419B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104656657A (zh) * | 2014-12-30 | 2015-05-27 | 南京航空航天大学 | 一种常值风干扰平流层飞艇定点控制方法 |
CN104793498A (zh) * | 2015-05-04 | 2015-07-22 | 中国人民解放军国防科学技术大学 | 一种自主飞艇定点驻留控制方法 |
CN106774385A (zh) * | 2016-12-05 | 2017-05-31 | 烟台南山学院 | 一种采用自适应变结构的飞艇定点悬停控制方法 |
Non-Patent Citations (2)
Title |
---|
MICHAL LOWER: ""Fuzzy Flight Control System for Helicopter Intelligence in Hover"", 《PROCEEDINGS OF THE 2005 5TH INTERNATIONAL CONFERENCE ON INTELLIGENT SYSTEMS DESIGN AND APPLICATIONS》 * |
朱迅: ""无人飞艇的定点悬浮与航迹跟踪控制律设计"", 《万方数据》 * |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107807666A (zh) * | 2017-11-29 | 2018-03-16 | 天津聚飞创新科技有限公司 | 飞行器、飞行控制方法及装置 |
CN108693883A (zh) * | 2018-06-06 | 2018-10-23 | 西安智加科技有限公司 | 一种车辆自动驾驶的高精度停车方法和系统 |
CN108693883B (zh) * | 2018-06-06 | 2021-12-24 | 苏州智加科技有限公司 | 一种车辆自动驾驶的高精度停车方法和系统 |
CN111752278A (zh) * | 2020-06-30 | 2020-10-09 | 珠海云洲智能科技有限公司 | 航行设备的定点控制方法、装置及电子设备 |
CN111752278B (zh) * | 2020-06-30 | 2021-11-30 | 珠海云洲智能科技股份有限公司 | 航行设备的定点控制方法、装置及电子设备 |
WO2024003549A1 (en) * | 2022-06-28 | 2024-01-04 | Avealto Ltd | A lighter than air vehicle and a communication system comprising the same |
Also Published As
Publication number | Publication date |
---|---|
CN107315419B (zh) | 2020-09-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102393200B (zh) | 基于飞行仿真的通用惯导测试方法 | |
CN107315419A (zh) | 一种实现飞艇远距离定点悬停的三段式控制策略 | |
CN103336863B (zh) | 基于雷达飞行航迹观测数据的飞行意图识别方法 | |
CN106527122A (zh) | 平流层飞艇定高飞行非线性pid控制方法 | |
CN109238636B (zh) | 一种级间分离风洞自由飞试验模型分离轨迹预估方法 | |
CN104199303B (zh) | 一种基于矢量场制导的平流层卫星平面路径跟踪控制方法 | |
CN108153323B (zh) | 一种高空无人飞行器高精度再入制导方法 | |
CN104777844B (zh) | 一种高超声速临近空间飞行器航迹跟踪方法 | |
CN109240335B (zh) | 一种空天飞行器进场着陆制导方法 | |
CN105202972A (zh) | 一种基于模型预测控制技术的多导弹协同作战制导方法 | |
CN106768123A (zh) | 一种无人直升机燃油预估方法 | |
CN103578299B (zh) | 一种模拟航空器飞行过程的方法 | |
CN107844128A (zh) | 一种基于复合比例导引的高超声速飞行器巡航段制导方法 | |
CN105242679A (zh) | 一种四旋翼飞行器的控制系统设计方法 | |
CN105652664A (zh) | 一种基于鸽群优化的四旋翼无人机显式预测控制方法 | |
CN106406333B (zh) | 一种基于积分型终端滑模的平流层飞艇俯仰角跟踪方法 | |
CN109737812A (zh) | 空对地制导武器侧向攻击方法和装置 | |
CN110781579A (zh) | 一种空投物体下落过程仿真方法 | |
CN106774385B (zh) | 一种采用自适应变结构的飞艇定点悬停控制方法 | |
CN106248082A (zh) | 一种飞行器自主导航系统及导航方法 | |
CN106681337B (zh) | 基于奇次滑模的平流层飞艇定高飞行控制方法 | |
CN104458202A (zh) | 发射式风洞自由飞试验中拍摄记录时间获取方法 | |
CN116702439B (zh) | 基于再入落点预测模型的仿真用飞行器再入落点预测方法 | |
CN106483967B (zh) | 一种基于角速度信息测量与滑模的飞艇俯仰角稳定方法 | |
CN106774370B (zh) | 实现飞艇按照给定速度稳定飞行的速度跟踪控制方法 |
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 |