CN115129084A - 一种飞翼布局无人机大侧偏着陆纠偏控制方法 - Google Patents
一种飞翼布局无人机大侧偏着陆纠偏控制方法 Download PDFInfo
- Publication number
- CN115129084A CN115129084A CN202210865070.8A CN202210865070A CN115129084A CN 115129084 A CN115129084 A CN 115129084A CN 202210865070 A CN202210865070 A CN 202210865070A CN 115129084 A CN115129084 A CN 115129084A
- Authority
- CN
- China
- Prior art keywords
- deviation
- control
- aerial vehicle
- unmanned aerial
- lateral
- 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 51
- 230000003416 augmentation Effects 0.000 claims abstract description 45
- 230000000694 effects Effects 0.000 claims abstract description 18
- 238000012937 correction Methods 0.000 claims description 134
- 238000013016 damping Methods 0.000 claims description 59
- 230000001276 controlling effect Effects 0.000 claims description 52
- 230000003068 static effect Effects 0.000 claims description 12
- 125000004432 carbon atom Chemical group C* 0.000 claims description 8
- 238000010612 desalination reaction Methods 0.000 claims description 8
- 238000005096 rolling process Methods 0.000 claims description 8
- 150000003377 silicon compounds Chemical class 0.000 claims description 7
- 238000013461 design Methods 0.000 claims description 6
- 150000007524 organic acids Chemical class 0.000 claims description 6
- 150000001875 compounds Chemical class 0.000 claims description 5
- 230000001105 regulatory effect Effects 0.000 claims description 5
- NAWXUBYGYWOOIX-SFHVURJKSA-N (2s)-2-[[4-[2-(2,4-diaminoquinazolin-6-yl)ethyl]benzoyl]amino]-4-methylidenepentanedioic acid Chemical compound C1=CC2=NC(N)=NC(N)=C2C=C1CCC1=CC=C(C(=O)N[C@@H](CC(=C)C(O)=O)C(O)=O)C=C1 NAWXUBYGYWOOIX-SFHVURJKSA-N 0.000 claims description 4
- OKTJSMMVPCPJKN-UHFFFAOYSA-N Carbon Chemical compound [C] OKTJSMMVPCPJKN-UHFFFAOYSA-N 0.000 claims description 2
- 229910052799 carbon Inorganic materials 0.000 claims description 2
- KXGFMDJXCMQABM-UHFFFAOYSA-N 2-methoxy-6-methylphenol Chemical compound [CH]OC1=CC=CC([CH])=C1O KXGFMDJXCMQABM-UHFFFAOYSA-N 0.000 claims 1
- 239000002253 acid Substances 0.000 claims 1
- 239000005011 phenolic resin Substances 0.000 claims 1
- 229920001568 phenolic resin Polymers 0.000 claims 1
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 abstract description 4
- 238000010586 diagram Methods 0.000 description 5
- 241000764238 Isis Species 0.000 description 2
- 230000005484 gravity Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
Images
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
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T50/00—Aeronautics or air transport
- Y02T50/40—Weight reduction
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
技术领域
本发明属于航空飞行控制技术领域,具体的说,是一种飞翼布局无人机大侧偏着陆纠偏控制方法。
背景技术
样例无人机为前三点式无人机,以机轮区别划分,可分为位于机身前部的前轮和位于机身两侧的两个主轮。其中,两个主轮对称安装在机身两侧,通常位于飞机重心后面,可分为左轮和右轮。前轮上安装有前轮转弯装置,可通过飞控计算机发送“前轮纠偏量”给前轮转弯装置,前轮转弯装置调整前轮角度进行前轮纠偏。而左轮和右轮上安装有刹车装置,当左轮和右轮存在不同的刹车量时,相对于飞机重心会造成额外的偏航力矩,使得飞控计算机根据飞机当前状况计算“刹车纠偏量”,并发送给左右刹车机构,从而实现主轮刹车纠偏。本专利中方向舵为差动式阻力方向舵,现有专利号为“CN111017197A”的专利中公开了一种无人机差动式方向舵伺服作动装置,本样例无人机采用的差动式阻力方向舵与上述专利一致。
通常的,无人机通过控制侧偏距和航向角进行地面纠偏,在着陆接地后,刹车、前轮和方向舵均使用纠偏控制律,但无人机大侧偏着陆时,由于无人机侧偏距差较大,三个纠偏控制通道(刹车纠偏通道、前轮纠偏通道、方向舵通道)中含侧偏距的控制项会瞬间出较大的纠偏量,从而导致飞机着陆接地后出现较大的扰动,严重时会出现无人机“地面打转”,存在着陆安全风险。
发明内容
本发明的目的是通过控制律分项限幅或者侧偏距软化手段,对现有控制器进行优化,解决了飞翼布局无人机大侧偏着陆纠偏时,含侧偏距的控制项会瞬间出现较大的纠偏量,从而导致飞机着陆后出现的较大扰动问题,提升无人机纠偏控制效果,降低无人机着陆安全风险。
为实现上述技术效果,本申请的技术方案如下:
一种飞翼布局无人机大侧偏着陆纠偏控制方法,包括如下步骤:
步骤一:设计方向舵通道增稳控制律;
步骤二:设计方向舵通道纠偏控制律;
步骤三:设计刹车纠偏控制律;
步骤四:设计前轮纠偏控制律;
步骤五:设计着陆前后方向舵通道增稳与纠偏控制律切换逻辑;
步骤六:设计大侧偏着陆时纠偏控制逻辑。
进一步地,步骤一具体为:
方向舵通道增稳控制律结构为:
其中,(1)式中控制参数为方向舵通道偏航角速率阻尼控制参数,用于增加系统阻尼,控制参数为方向舵通道侧滑角增稳控制参数,用于荷兰滚模态增稳,控制参数为方向舵通道侧滑角速率增稳控制参数,用于荷兰滚模态增稳,物理量Δδr为增稳引起的舵偏量,物理量r为无人机偏航角速率,物理量β为无人机侧滑角,物理量为无人机侧滑角速率,(2)式中物理量α为无人机攻角;
控制器在运行时,首先按式(2)计算无人机侧滑角速率,按式(1)计算出方向舵增稳舵偏量增量,发送至执行机构,完成整个方向舵通道增稳控制律设计。
进一步地,步骤二具体为:
方向舵通道纠偏控制律结构为:
其中,控制参数为方向舵通道随速度变化的调参因子,实现低速切入和切除的滑行效果,控制参数为方向舵通道侧偏距纠偏控制参数,用于调整飞机侧偏距,控制参数为方向舵通道侧偏距积分纠偏控制参数,用于消除侧偏距静差,控制参数为方向舵通道航向角纠偏控制参数,用于调整飞机航向角,控制参数为方向舵通道偏航角速率纠偏控制参数,用于增加纠偏时航向方面的阻尼,控制参数为方向舵通道侧偏移速率纠偏控制参数,用于增加纠偏时侧偏距方面的阻尼;物理量Δδrg为纠偏引起的舵偏量,物理量ΔY为无人机侧偏距差,为无人机侧偏距与无人机侧偏距指令值的差值,物理量Δψ为无人机航向角差,为无人机航向角指令值与无人机航向角的差值,物理量r为无人机偏航角速率,物理量为无人机侧偏移速率;
控制器在运行时,对侧偏距差进行比例积分控制,并辅以阻尼控制,同时,对航向角差进行比例控制,并辅以阻尼控制,最终计算得出方向舵的纠偏舵偏量增量,并发送至方向舵执行机构,实现方向舵纠偏控制。
其中,式(4)的参数V1 G=10km/h,V2 G=20km/h,V3 G=300km/h,V4 G=340km/h,物理量VG为飞机地速。
进一步地,步骤三具体为:
刹车纠偏控制律结构为:
其中,控制参数为刹车纠偏随速度变化的调参因子,实现低速切入和切除的滑行效果,控制参数为刹车纠偏侧偏距控制参数,用于调整飞机侧偏距,控制参数为刹车纠偏侧偏距积分控制参数,用于消除侧偏距静差,控制参数为刹车纠偏航向角控制参数,用于调整飞机航向角,控制参数为刹车纠偏偏航角速率控制参数,用于增加纠偏时航向方面的阻尼,控制参数为刹车纠偏侧偏移速率控制参数,用于增加纠偏时侧偏距方面的阻尼,物理量Δδb为刹车纠偏引起的刹车纠偏量,物理量ΔY为无人机侧偏距差,为无人机侧偏距与无人机侧偏距指令值的差值,物理量Δψ为无人机航向角差,为无人机航向角指令值与无人机航向角的差值,物理量r为无人机偏航角速率,物理量为无人机侧偏移速率;
控制器在运行时,对侧偏距差进行比例积分控制,并辅以阻尼控制,同时,对航向角差进行比例控制,并辅以阻尼控制,最终计算得出刹车纠偏增量,并发送至左右刹车执行机构,实现刹车纠偏控制。
其中,参数V2 G=195km/h,V3 G=200km/h,物理量VG为飞机地速。
进一步地,步骤四具体为:
前轮纠偏控制律结构为:
其中,控制参数为前轮纠偏随速度变化的调参因子,实现低速切入和切除的滑行效果,控制参数为前轮纠偏侧偏距控制参数,用于调整飞机侧偏距,控制参数为前轮纠偏侧偏距积分控制参数,用于消除侧偏距静差,控制参数为前轮纠偏航向角控制参数,用于调整飞机航向角,控制参数为前轮纠偏偏航角速率控制参数,用于增加纠偏时航向方面的阻尼,控制参数为前轮纠偏侧偏移速率控制参数,用于增加纠偏时侧偏距方面的阻尼,物理量ΔδNW为前轮纠偏引起的前轮纠偏量,物理量ΔY为无人机侧偏距差,为无人机侧偏距与无人机侧偏距指令值的差值,物理量Δψ为无人机航向角差,为无人机航向角指令值与无人机航向角的差值,物理量r为无人机偏航角速率,物理量为无人机侧偏移速率;
控制器在运行时,对侧偏距差进行比例积分控制,并辅以阻尼控制,同时,对航向角差进行比例控制,并辅以阻尼控制,最终计算得出前轮纠偏量,并发送至前轮转弯执行机构中,实现前轮纠偏控制。
其中,参数V1 G=180km/h,V2 G=250km/h,物理量VG为飞机地速。
进一步地,步骤五为设计着陆前后方向舵通道增稳与纠偏控制律切换逻辑,
无人机在着陆前的最后一个阶段,需要进行航向对准,保证飞机机头方向对准跑道,即进行有侧滑飞行;
航向对准段无人机方向舵通道控制律如式(9)所示。
着陆滑跑段无人机方向舵通道控制律如式(10)所示。
δr=Δδr+Δδrg (10)
其中,式(9)中控制参数为方向舵通道侧滑角控制参数,控制参数为方向舵通道航向角差控制参数,物理量δr为方向舵舵面控制量,物理量Δδrg为方向舵纠偏控制增量,物理量Δδr为方向舵增稳控制增量,且一般在接地后n秒内进行淡化,至m秒时淡化为0。
进一步地,步骤六设计大侧偏着陆时纠偏控制逻辑为设计大侧偏着陆时各纠偏控制律分项限幅,具体为:
飞机在着陆滑跑段,进行限幅,方向舵分项限幅值可如下所示:
飞机在着陆滑跑段进行限幅,刹车纠偏分项限幅值可如下所示:
飞机在着陆滑跑段进行限幅,前轮纠偏分项限幅值可如下所示:
进一步地,步骤六设计大侧偏着陆时纠偏控制逻辑为设计大侧偏着陆时侧偏距软化逻辑,
具体为:
飞机的侧偏距为Y,侧偏距指令值为Yg,飞机的侧偏距差表示为
ΔY=Y-Yg (11)
取飞机接地时刻的侧偏距Y′,启用大侧偏着陆纠偏逻辑的侧偏距阈值为Y*,飞机侧偏距软化时间为T,以接地时刻开始计时,启用大侧偏着陆纠偏逻辑后,侧偏距指令值Yg可表达为落地后时间t的函数,如公式(12)所示:
再进一步地,Y*为5m,T为30s。
更进一步地,本专利适用于所有使用侧偏距进行着陆纠偏控制的无人机。
本发明有益效果是:
本专利通过控制律分项限幅或者侧偏距软化手段,对现有控制器进行优化,解决了飞翼布局无人机大侧偏着陆纠偏时,含侧偏距的控制项会瞬间出现较大的纠偏量,从而导致飞机着陆后出现的较大扰动问题,提升了无人机纠偏控制效果,降低了无人机着陆安全风险。
附图说明
图1为本发明所述的方向舵通道增稳控制结构图。
图2为本发明所述的方向舵通道纠偏控制结构图。
图3为本发明所述的刹车纠偏控制结构图。
图4为本发明所述的前轮纠偏控制结构图。
图5为本发明实施例2所述的侧偏距软化逻辑示意图。
控制参数为方向舵通道随速度变化的调参因子,控制参数为方向舵通道侧偏距纠偏控制参数,控制参数为方向舵通道侧偏距积分纠偏控制参数,控制参数为方向舵通道航向角纠偏控制参数,控制参数为方向舵通道偏航角速率纠偏控制参数,控制参数为方向舵通道侧偏移速率纠偏控制参数。
控制参数为刹车纠偏随速度变化的调参因子,控制参数为刹车纠偏侧偏距控制参数,控制参数为刹车纠偏侧偏距积分控制参数,控制参数为刹车纠偏航向角控制参数,控制参数为刹车纠偏偏航角速率控制参数,控制参数为刹车纠偏侧偏移速率控制参数。
控制参数为前轮纠偏随速度变化的调参因子,控制参数为前轮纠偏侧偏距控制参数,控制参数为前轮纠偏侧偏距积分控制参数,控制参数为前轮纠偏航向角控制参数,控制参数为前轮纠偏偏航角速率控制参数,控制参数为前轮纠偏测偏移速率控制参数。
物理量Δδr为方向舵增稳控制增量,物理量Δδrg为方向舵纠偏控制增量,物理量ΔδNW为前轮纠偏引起的前轮纠偏量,物理量Δδb为刹车纠偏引起的刹车纠偏量。
具体实施方式
下面结合试验例及具体实施方式对本发明作进一步的详细描述。但不应将此理解为本发明上述主题的范围仅限于以下的实施例,凡基于本发明内容所实现的技术均属于本发明的范围。
实施例1
一种飞翼布局无人机大侧偏着陆纠偏控制方法,其包含以下步骤:
步骤一:设计方向舵通道增稳控制律;
步骤二:设计方向舵通道纠偏控制律;
步骤三:设计刹车纠偏控制律;
步骤四:设计前轮纠偏控制律;
步骤五:设计着陆前后方向舵通道增稳与纠偏控制律切换逻辑;
步骤六:设计大侧偏着陆时各纠偏控制律分项限幅;
步骤一具体:
图1,示出了方向舵通道增稳控制律,其控制律结构为:
其中,(1)式中控制参数为方向舵通道偏航角速率阻尼控制参数,主要用于增加系统阻尼,控制参数为方向舵通道侧滑角增稳控制参数,主要用于荷兰滚模态增稳,控制参数为方向舵通道侧滑角速率增稳控制参数,主要用于荷兰滚模态增稳。物理量Δδr为增稳引起的舵偏量,物理量r为无人机偏航角速率,物理量β为无人机侧滑角,物理量为无人机侧滑角速率,(2)式中物理量α为无人机攻角。
控制器在运行时,首先按式(2)计算无人机侧滑角速率,按式(1)计算出方向舵增稳舵偏量增量,发送至执行机构,完成整个方向舵通道增稳控制律设计。
步骤二具体:
图2,示出了方向舵通道纠偏控制律,其控制律结构为:
其中,控制参数为方向舵通道随速度变化的调参因子,实现低速切入和切除的滑行效果,控制参数为方向舵通道侧偏距纠偏控制参数,主要用于调整飞机侧偏距,控制参数为方向舵通道侧偏距积分纠偏控制参数,主要用于消除侧偏距静差,控制参数为方向舵通道航向角纠偏控制参数,主要用于调整飞机航向角,控制参数为方向舵通道偏航角速率纠偏控制参数,主要用于增加纠偏时航向方面的阻尼,控制参数为方向舵通道侧偏移速率纠偏控制参数,主要用于增加纠偏时侧偏距方面的阻尼。物理量Δδrg为纠偏引起的舵偏量,物理量ΔY为无人机侧偏距差,具体为无人机侧偏距与无人机侧偏距指令值的差值,物理量Δψ为无人机航向角差,具体为无人机航向角指令值与无人机航向角的差值,物理量r为无人机偏航角速率,物理量为无人机侧偏移速率。
控制器在运行时,对侧偏距差进行比例积分控制,并辅以阻尼控制,同时,对航向角差进行比例控制,并辅以阻尼控制,最终计算得出方向舵的纠偏舵偏量增量,并发送至方向舵执行机构,实现方向舵纠偏控制。
其中,式(4)的参数V1 G=10km/h,V2 G=20km/h,V3 G=300km/h,V4 G=340km/h,物理量VG为飞机地速。
步骤三具体:
图3,示出了刹车纠偏控制律,其控制律结构为:
其中,控制参数为刹车纠偏随速度变化的调参因子,实现低速切入和切除的滑行效果,控制参数为刹车纠偏侧偏距控制参数,主要用于调整飞机侧偏距,控制参数为刹车纠偏侧偏距积分控制参数,主要用于消除侧偏距静差,控制参数为刹车纠偏航向角控制参数,主要用于调整飞机航向角,控制参数为刹车纠偏偏航角速率控制参数,主要用于增加纠偏时航向方面的阻尼,控制参数为刹车纠偏侧偏移速率控制参数,主要用于增加纠偏时侧偏距方面的阻尼。物理量Δδb为刹车纠偏引起的刹车纠偏量,物理量ΔY为无人机侧偏距差,具体为无人机侧偏距与无人机侧偏距指令值的差值,物理量Δψ为无人机航向角差,具体为无人机航向角指令值与无人机航向角的差值,物理量r为无人机偏航角速率,物理量为无人机侧偏移速率。
控制器在运行时,对侧偏距差进行比例积分控制,并辅以阻尼控制,同时,对航向角差进行比例控制,并辅以阻尼控制,最终计算得出刹车纠偏增量,并发送至左右刹车执行机构,实现刹车纠偏控制。
其中,参数V2 G=195km/h,V3 G=200km/h,物理量VG为飞机地速。
步骤四具体:
图4,示出了前轮纠偏控制律,其控制律结构为:
其中,控制参数为前轮纠偏随速度变化的调参因子,实现低速切入和切除的滑行效果,控制参数为前轮纠偏侧偏距控制参数,主要用于调整飞机侧偏距,控制参数为前轮纠偏侧偏距积分控制参数,主要用于消除侧偏距静差,控制参数为前轮纠偏航向角控制参数,主要用于调整飞机航向角,控制参数为前轮纠偏偏航角速率控制参数,主要用于增加纠偏时航向方面的阻尼,控制参数为前轮纠偏侧偏移速率控制参数,主要用于增加纠偏时侧偏距方面的阻尼。物理量ΔδNW为前轮纠偏引起的前轮纠偏量,物理量ΔY为无人机侧偏距差,具体为无人机侧偏距与无人机侧偏距指令值的差值,物理量Δψ为无人机航向角差,具体为无人机航向角指令值与无人机航向角的差值,物理量r为无人机偏航角速率,物理量为无人机侧偏移速率。
控制器在运行时,对侧偏距差进行比例积分控制,并辅以阻尼控制,同时,对航向角差进行比例控制,并辅以阻尼控制,最终计算得出前轮纠偏量,并发送至前轮转弯执行机构中,实现前轮纠偏控制。
其中,参数V1 G=180km/h,V2 G=250km/h,物理量VG为飞机地速。
步骤五具体:
设计着陆前后方向舵通道增稳与纠偏控制律切换逻辑。
无人机在着陆前的最后一个阶段,需要进行航向对准,保证飞机机头方向对准跑道,即进行有侧滑飞行。
航向对准段无人机方向舵通道控制律如式(9)所示。
着陆滑跑段无人机方向舵通道控制律如式(10)所示。
δr=Δδr+Δδrg (10)
其中,式(9)中控制参数为方向舵通道侧滑角控制参数,控制参数为方向舵通道航向角差控制参数,物理量δr为方向舵舵面控制量,物理量Δδrg为方向舵纠偏控制增量,物理量Δδr为方向舵增稳控制增量,且一般在接地后n秒内进行淡化,至m秒时淡化为0。
步骤六具体:
设计大侧偏着陆时各纠偏控制律分项限幅。
一般地,飞机在大侧偏着陆时,需要慢慢出纠偏量,保证高速情况下飞机能够沿跑道方向进行滑行,实现高速主控航向的效果。
进一步的,飞机在着陆滑跑段,进行限幅,方向舵分项限幅值可如下所示。
进一步的,飞机在着陆滑跑段进行限幅,刹车纠偏分项限幅值可如下所示。
进一步的,飞机在着陆滑跑段进行限幅,前轮纠偏分项限幅值可如下所示。
实施例2
一种飞翼布局无人机大侧偏着陆纠偏控制方法,其包含以下步骤,如图1所示:
步骤一:设计方向舵通道增稳控制律;
步骤二:设计方向舵通道纠偏控制律;
步骤三:设计刹车纠偏控制律;
步骤四:设计前轮纠偏控制律;
步骤五:设计着陆前后方向舵通道增稳与纠偏控制律切换逻辑;
步骤六:设计大侧偏着陆时侧偏距软化逻辑;
步骤一具体:
图1,示出了方向舵通道增稳控制律,其控制律结构为:
其中,(1)式中控制参数为方向舵通道偏航角速率阻尼控制参数,主要用于增加系统阻尼,控制参数为方向舵通道侧滑角增稳控制参数,主要用于荷兰滚模态增稳,控制参数为方向舵通道侧滑角速率增稳控制参数,主要用于荷兰滚模态增稳。物理量Δδr为增稳引起的舵偏量,物理量r为无人机偏航角速率,物理量β为无人机侧滑角,物理量为无人机侧滑角速率,(2)式中物理量α为无人机攻角。
控制器在运行时,首先按式(2)计算无人机侧滑角速率,按式(1)计算出方向舵增稳舵偏量增量,发送至执行机构,完成整个方向舵通道增稳控制律设计。
步骤二具体:
图2,示出了方向舵通道纠偏控制律,其控制律结构为:
其中,控制参数为方向舵通道随速度变化的调参因子,实现低速切入和切除的滑行效果,控制参数为方向舵通道侧偏距纠偏控制参数,主要用于调整飞机侧偏距,控制参数为方向舵通道侧偏距积分纠偏控制参数,主要用于消除侧偏距静差,控制参数为方向舵通道航向角纠偏控制参数,主要用于调整飞机航向角,控制参数为方向舵通道偏航角速率纠偏控制参数,主要用于增加纠偏时航向方面的阻尼,控制参数为方向舵通道侧偏移速率纠偏控制参数,主要用于增加纠偏时侧偏距方面的阻尼。物理量Δδrg为纠偏引起的舵偏量,物理量ΔY为无人机侧偏距差,具体为无人机侧偏距与无人机侧偏距指令值的差值,物理量Δψ为无人机航向角差,具体为无人机航向角指令值与无人机航向角的差值,物理量r为无人机偏航角速率,物理量为无人机侧偏移速率。
控制器在运行时,对侧偏距差进行比例积分控制,并辅以阻尼控制,同时,对航向角差进行比例控制,并辅以阻尼控制,最终计算得出方向舵的纠偏舵偏量增量,并发送至方向舵执行机构,实现方向舵纠偏控制。
其中,式(4)的参数V1 G=10km/h,V2 G=20km/h,V3 G=300km/h,V4 G=340km/h,物理量VG为飞机地速。
步骤三具体:
图3,示出了刹车纠偏控制律,其控制律结构为:
其中,控制参数为刹车纠偏随速度变化的调参因子,实现低速切入和切除的滑行效果,控制参数为刹车纠偏侧偏距控制参数,主要用于调整飞机侧偏距,控制参数为刹车纠偏侧偏距积分控制参数,主要用于消除侧偏距静差,控制参数为刹车纠偏航向角控制参数,主要用于调整飞机航向角,控制参数为刹车纠偏偏航角速率控制参数,主要用于增加纠偏时航向方面的阻尼,控制参数为刹车纠偏侧偏移速率控制参数,主要用于增加纠偏时侧偏距方面的阻尼。物理量Δδb为刹车纠偏引起的刹车纠偏量,物理量ΔY为无人机侧偏距差,具体为无人机侧偏距与无人机侧偏距指令值的差值,物理量Δψ为无人机航向角差,具体为无人机航向角指令值与无人机航向角的差值,物理量r为无人机偏航角速率,物理量为无人机侧偏移速率。
控制器在运行时,对侧偏距差进行比例积分控制,并辅以阻尼控制,同时,对航向角差进行比例控制,并辅以阻尼控制,最终计算得出刹车纠偏增量,并发送至左右刹车执行机构,实现刹车纠偏控制。
其中,参数V2 G=195km/h,V3 G=200km/h,物理量VG为飞机地速。
步骤四具体:
图4,示出了前轮纠偏控制律,其控制律结构为:
其中,控制参数为前轮纠偏随速度变化的调参因子,实现低速切入和切除的滑行效果,控制参数为前轮纠偏侧偏距控制参数,主要用于调整飞机侧偏距,控制参数为前轮纠偏侧偏距积分控制参数,主要用于消除侧偏距静差,控制参数为前轮纠偏航向角控制参数,主要用于调整飞机航向角,控制参数为前轮纠偏偏航角速率控制参数,主要用于增加纠偏时航向方面的阻尼,控制参数为前轮纠偏侧偏移速率控制参数,主要用于增加纠偏时侧偏距方面的阻尼。物理量Δδrg为前轮纠偏引起的舵偏量,物理量ΔY为无人机侧偏距差,具体为无人机侧偏距与无人机侧偏距指令值的差值,物理量Δψ为无人机航向角差,具体为无人机航向角指令值与无人机航向角的差值,物理量r为无人机偏航角速率,物理量为无人机侧偏移速率。
控制器在运行时,对侧偏距差进行比例积分控制,并辅以阻尼控制,同时,对航向角差进行比例控制,并辅以阻尼控制,最终计算得出前轮纠偏量,并发送至前轮转弯执行机构中,实现前轮纠偏控制。
其中,参数V1 G=180km/h,V2 G=250km/h,物理量VG为飞机地速。
步骤五具体:
设计着陆前后方向舵通道增稳与纠偏控制律切换逻辑。
无人机在着陆前的最后一个阶段,需要进行航向对准,保证飞机机头方向对准跑道,即进行有侧滑飞行。
航向对准段无人机方向舵通道控制律如式(9)所示。
着陆滑跑段无人机方向舵通道控制律如式(10)所示。
δr=Δδr+Δδrg (10)
其中,式(9)中控制参数为方向舵通道侧滑角控制参数,控制参数为方向舵通道航向角差控制参数,物理量δr为方向舵舵面控制量,物理量Δδrg为方向舵纠偏控制增量,物理量Δδr为方向舵增稳控制增量,且一般在接地后n秒内进行淡化,至m秒时淡化为0。
步骤六具体:
设计大侧偏着陆时侧偏距软化逻辑。
一般地,飞机在大侧偏着陆时,需要慢慢出纠偏量,保证高速情况下飞机能够沿跑道方向进行滑行,实现高速主控航向的效果。
而飞机在着陆时,经过步骤五的航向对准后,航向一般是对准跑道的,那么仅需要对侧偏距差进行软化处理。
飞机的侧偏距为Y,侧偏距指令值为Yg,飞机的侧偏距差可表示为
ΔY=Y-Yg (11)
取飞机接地时刻的侧偏距Y′,启用大侧偏着陆纠偏逻辑的侧偏距阈值为Y*,飞机侧偏距软化时间为T,以接地时刻开始计时。启用大侧偏着陆纠偏逻辑后,侧偏距指令值Yg可表达为落地后时间t的函数,如公式(12)所示,也可如图5直观表示出。
进一步的,Y*可以为5m,T可以为30s。
更进一步的,本专利适用于所有使用侧偏距进行着陆纠偏控制的无人机。
Claims (17)
1.一种飞翼布局无人机大侧偏着陆纠偏控制方法,其特征在于:包括如下步骤:
步骤一:设计方向舵通道增稳控制律;
步骤二:设计方向舵通道纠偏控制律;
步骤三:设计刹车纠偏控制律;
步骤四:设计前轮纠偏控制律;
步骤五:设计着陆前后方向舵通道增稳与纠偏控制律切换逻辑;
步骤六:设计大侧偏着陆时纠偏控制逻辑。
2.根据权利要求1所述的一种飞翼布局无人机大侧偏着陆纠偏控制方法,其特征在于:步骤一具体为:
方向舵通道增稳控制律结构为:
其中,(1)式中控制参数为方向舵通道偏航角速率阻尼控制参数,用于增加系统阻尼,控制参数为方向舵通道侧滑角增稳控制参数,用于荷兰滚模态增稳,控制参数为方向舵通道侧滑角速率增稳控制参数,用于荷兰滚模态增稳,物理量△δr为增稳引起的舵偏量,物理量r为无人机偏航角速率,物理量β为无人机侧滑角,物理量为无人机侧滑角速率,(2)式中物理量α为无人机攻角;
控制器在运行时,首先按式(2)计算无人机侧滑角速率,按式(1)计算出方向舵增稳舵偏量增量,发送至执行机构,完成整个方向舵通道增稳控制律设计。
4.根据权利要求1所述的一种飞翼布局无人机大侧偏着陆纠偏控制方法,其特征在于:步骤二具体为:
方向舵通道纠偏控制律结构为:
其中,控制参数为方向舵通道随速度变化的调参因子,实现低速切入和切除的滑行效果,控制参数为方向舵通道侧偏距纠偏控制参数,用于调整飞机侧偏距,控制参数为方向舵通道侧偏距积分纠偏控制参数,用于消除侧偏距静差,控制参数为方向舵通道航向角纠偏控制参数,用于调整飞机航向角,控制参数为方向舵通道偏航角速率纠偏控制参数,用于增加纠偏时航向方面的阻尼,控制参数为方向舵通道侧偏移速率纠偏控制参数,用于增加纠偏时侧偏距方面的阻尼;物理量△δrg为纠偏引起的舵偏量,物理量△Y为无人机侧偏距差,为无人机侧偏距与无人机侧偏距指令值的差值,物理量△ψ为无人机航向角差,为无人机航向角指令值与无人机航向角的差值,物理量r为无人机偏航角速率,物理量为无人机侧偏移速率;
控制器在运行时,对侧偏距差进行比例积分控制,并辅以阻尼控制,同时,对航向角差进行比例控制,并辅以阻尼控制,最终计算得出方向舵的纠偏舵偏量增量,并发送至方向舵执行机构,实现方向舵纠偏控制。
7.根据权利要求1所述的一种飞翼布局无人机大侧偏着陆纠偏控制方法,其特征在于:步骤三具体为:
刹车纠偏控制律结构为:
其中,控制参数为刹车纠偏随速度变化的调参因子,实现低速切入和切除的滑行效果,控制参数为刹车纠偏侧偏距控制参数,用于调整飞机侧偏距,控制参数为刹车纠偏侧偏距积分控制参数,用于消除侧偏距静差,控制参数为刹车纠偏航向角控制参数,用于调整飞机航向角,控制参数为刹车纠偏偏航角速率控制参数,用于增加纠偏时航向方面的阻尼,控制参数为刹车纠偏侧偏移速率控制参数,用于增加纠偏时侧偏距方面的阻尼,物理量△δb为刹车纠偏引起的刹车纠偏量,物理量△Y为无人机侧偏距差,为无人机侧偏距与无人机侧偏距指令值的差值,物理量△ψ为无人机航向角差,为无人机航向角指令值与无人机航向角的差值,物理量r为无人机偏航角速率,物理量为无人机侧偏移速率;
控制器在运行时,对侧偏距差进行比例积分控制,并辅以阻尼控制,同时,对航向角差进行比例控制,并辅以阻尼控制,最终计算得出刹车纠偏增量,并发送至左右刹车执行机构,实现刹车纠偏控制。
10.根据权利要求1所述的一种飞翼布局无人机大侧偏着陆纠偏控制方法,其特征在于:步骤四具体为:
前轮纠偏控制律结构为:
其中,控制参数为前轮纠偏随速度变化的调参因子,实现低速切入和切除的滑行效果,控制参数为前轮纠偏侧偏距控制参数,用于调整飞机侧偏距,控制参数为前轮纠偏侧偏距积分控制参数,用于消除侧偏距静差,控制参数为前轮纠偏航向角控制参数,用于调整飞机航向角,控制参数为前轮纠偏偏航角速率控制参数,用于增加纠偏时航向方面的阻尼,控制参数为前轮纠偏侧偏移速率控制参数,用于增加纠偏时侧偏距方面的阻尼,物理量△δNW为前轮纠偏引起的前轮纠偏量,物理量△Y为无人机侧偏距差,为无人机侧偏距与无人机侧偏距指令值的差值,物理量△ψ为无人机航向角差,为无人机航向角指令值与无人机航向角的差值,物理量r为无人机偏航角速率,物理量为无人机侧偏移速率;
控制器在运行时,对侧偏距差进行比例积分控制,并辅以阻尼控制,同时,对航向角差进行比例控制,并辅以阻尼控制,最终计算得出前轮纠偏量,并发送至前轮转弯执行机构中,实现前轮纠偏控制。
13.根据权利要求1所述的一种飞翼布局无人机大侧偏着陆纠偏控制方法,其特征在于:步骤五为设计着陆前后方向舵通道增稳与纠偏控制律切换逻辑,
无人机在着陆前的最后一个阶段,需要进行航向对准,保证飞机机头方向对准跑道,即进行有侧滑飞行;
航向对准段无人机方向舵通道控制律如式(9)所示。
着陆滑跑段无人机方向舵通道控制律如式(10)所示。
δr=△δr+△δrg (10)
17.根据权利要求16所述的一种飞翼布局无人机大侧偏着陆纠偏控制方法,其特征在于:Y*为5m,T为30s。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210865070.8A CN115129084B (zh) | 2022-07-21 | 2022-07-21 | 一种飞翼布局无人机大侧偏着陆纠偏控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210865070.8A CN115129084B (zh) | 2022-07-21 | 2022-07-21 | 一种飞翼布局无人机大侧偏着陆纠偏控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115129084A true CN115129084A (zh) | 2022-09-30 |
CN115129084B CN115129084B (zh) | 2024-06-11 |
Family
ID=83384893
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210865070.8A Active CN115129084B (zh) | 2022-07-21 | 2022-07-21 | 一种飞翼布局无人机大侧偏着陆纠偏控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115129084B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117289715A (zh) * | 2023-09-14 | 2023-12-26 | 成都飞机工业(集团)有限责任公司 | 一种飞翼布局无人机航向对准控制方法 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4482961A (en) * | 1981-09-18 | 1984-11-13 | The Boeing Company | Automatic control system for directional control of an aircraft during landing rollout |
CN106542083A (zh) * | 2016-11-25 | 2017-03-29 | 北京理工大学 | 一种小型无人机滑跑增稳控制方法 |
CN109085849A (zh) * | 2018-08-28 | 2018-12-25 | 成都飞机工业(集团)有限责任公司 | 一种舰载无人机定点着陆的自主控制方法 |
CN110764528A (zh) * | 2019-10-18 | 2020-02-07 | 北京航天长征飞行器研究所 | 一种舰载火箭弹垂直转弯控制方法 |
JP2020192906A (ja) * | 2019-05-29 | 2020-12-03 | 三菱重工業株式会社 | 移動体の制御装置、制御方法及びプログラム |
CN113741515A (zh) * | 2021-08-25 | 2021-12-03 | 成都飞机工业(集团)有限责任公司 | 面向前轮非零位的着陆滑跑前轮纠偏控制方法及系统 |
CN114675663A (zh) * | 2022-03-18 | 2022-06-28 | 成都飞机工业(集团)有限责任公司 | 一种侧风环境下无人机着陆的规划及控制方法 |
-
2022
- 2022-07-21 CN CN202210865070.8A patent/CN115129084B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4482961A (en) * | 1981-09-18 | 1984-11-13 | The Boeing Company | Automatic control system for directional control of an aircraft during landing rollout |
CN106542083A (zh) * | 2016-11-25 | 2017-03-29 | 北京理工大学 | 一种小型无人机滑跑增稳控制方法 |
CN109085849A (zh) * | 2018-08-28 | 2018-12-25 | 成都飞机工业(集团)有限责任公司 | 一种舰载无人机定点着陆的自主控制方法 |
JP2020192906A (ja) * | 2019-05-29 | 2020-12-03 | 三菱重工業株式会社 | 移動体の制御装置、制御方法及びプログラム |
CN110764528A (zh) * | 2019-10-18 | 2020-02-07 | 北京航天长征飞行器研究所 | 一种舰载火箭弹垂直转弯控制方法 |
CN113741515A (zh) * | 2021-08-25 | 2021-12-03 | 成都飞机工业(集团)有限责任公司 | 面向前轮非零位的着陆滑跑前轮纠偏控制方法及系统 |
CN114675663A (zh) * | 2022-03-18 | 2022-06-28 | 成都飞机工业(集团)有限责任公司 | 一种侧风环境下无人机着陆的规划及控制方法 |
Non-Patent Citations (1)
Title |
---|
郭杰,等: "小型无人机滑跑航向纠偏及增稳控制设计", 《北京理工大学学报》, vol. 37, no. 12, 31 December 2017 (2017-12-31) * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117289715A (zh) * | 2023-09-14 | 2023-12-26 | 成都飞机工业(集团)有限责任公司 | 一种飞翼布局无人机航向对准控制方法 |
CN117289715B (zh) * | 2023-09-14 | 2024-06-11 | 成都飞机工业(集团)有限责任公司 | 一种飞翼布局无人机航向对准控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN115129084B (zh) | 2024-06-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105159308B (zh) | 一种可重复使用飞行器着陆段制导与控制律一体化耦合设计方法 | |
CN111114761B (zh) | 飞行器起落架纵向力控制 | |
CN110007683B (zh) | 一种小展弦比飞翼无人机抗侧风着陆的控制方法 | |
CN103625637B (zh) | 一种大型飞机侧向阵风缓和方法 | |
CN107745822B (zh) | 一种无人机侧风着陆控制方法 | |
CN108089593B (zh) | 一种无人直升机航向补偿航线过渡的方法 | |
CN113093774B (zh) | 无人机滑跑控制方法 | |
US5375793A (en) | Process for the control of the control surfaces of an aircraft for the low speed compensation of a lateral path deviation | |
CN107544530A (zh) | 一种无人机自主驶入驶出控制方法 | |
CN105857586B (zh) | 用于控制可转向起落架的方法和设备 | |
CN112810804B (zh) | 基于制动力再分配的飞机地面滑跑纠偏控制系统及方法 | |
CN115129084A (zh) | 一种飞翼布局无人机大侧偏着陆纠偏控制方法 | |
CN110008600A (zh) | 车辆稳定性控制器性能保守性的设计方法 | |
US20080133074A1 (en) | Autonomous rollout control of air vehicle | |
CN106542083B (zh) | 一种小型无人机滑跑增稳控制方法 | |
Yan et al. | Research on taxi modeling and taking-off control for UAV | |
CN115933733A (zh) | 一种固定翼无人机纵向高度速度解耦非线性控制方法 | |
Dong et al. | Dynamic allocation algorithm for the gain of UAV nose wheel steering and differential braking based on decomposition control | |
CN114675663A (zh) | 一种侧风环境下无人机着陆的规划及控制方法 | |
CN113741515A (zh) | 面向前轮非零位的着陆滑跑前轮纠偏控制方法及系统 | |
Arrow | An analysis of aerodynamic requirements for coordinated bank-to-turn autopilots | |
US20220365531A1 (en) | Heading control system | |
CN107168374B (zh) | 横向平面的自适应比例微分导引方法 | |
CN117289715B (zh) | 一种飞翼布局无人机航向对准控制方法 | |
Hu | A small UAV deviation control roll research |
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 |