CN104298246A - 一种盘旋飞行轨迹的导引律设计方法及系统 - Google Patents
一种盘旋飞行轨迹的导引律设计方法及系统 Download PDFInfo
- Publication number
- CN104298246A CN104298246A CN201410453969.4A CN201410453969A CN104298246A CN 104298246 A CN104298246 A CN 104298246A CN 201410453969 A CN201410453969 A CN 201410453969A CN 104298246 A CN104298246 A CN 104298246A
- Authority
- CN
- China
- Prior art keywords
- aircraft
- lmda
- guidance instruction
- guidance
- instruction
- 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
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种盘旋飞行轨迹的导引律设计方法及系统,方法包括以下步骤:S1、采集飞行器的速度V、飞行器在发射系下的当前横向位置Zt以及飞行器完成反向180°盘旋结束点在发射系下的横向位置Z,获取飞行器飞行器中制导指令AzO;S2、获取飞行器末制导指令Az1;S3、根据飞行器中制导指令AzO和末制导指令Az1确定飞行器最终的制导指令Az,作为自动驾驶仪的输入指令从而实现飞行器的反向180°盘旋飞行。本发明还提供了一种实现上述方法的系统。实施本发明可以非常便捷地实现飞行器反向180°飞行,具有算法简单、易于工程实现、对自动驾驶仪压力小的优点。
Description
技术领域
本发明属于导引律技术领域,具体涉及到一种盘旋飞行轨迹的导引律设计方法及系统。
背景技术
国内目前的180度反向盘旋飞行的导引律设计基本上都是在地面离线规划飞行轨迹,装载于计算机存贮体中。随后在真实飞行过程中,通过飞行器实际位置和速度与装载于计算机存贮体中的飞行器进行比对得到偏差值,修正偏差值从而实现飞行器的盘旋飞行。
但是此类传统方法存在如下缺陷:当飞行器起控时刻初始值距离地面离线规划的飞行轨迹值存在较大偏差时,地面离线规划的飞行轨迹已经不再是最优轨迹;若是仍然将飞行器导引到地面离线规划飞行轨迹上,所需过载较大,攻角变化迅速,给自动驾驶仪设计带来不必要的抗干扰需求。
发明内容
针对现有技术的缺陷和技术需求,本发明提供了一种盘旋飞行轨迹的导引律设计方法及系统,可解决现有技术过载较大、攻角变化迅速、给自动驾驶仪带来不必要的抗干扰需求的缺陷。
为实现上述目的,按照本发明,提供了一种盘旋飞行轨迹的导引律设计方法,所述方法包括以下步骤:
S1、采集飞行器的速度V、飞行器在发射系下的当前横向位置Zt以及飞行器完成反向180°盘旋结束点在发射系下的横向位置Z,获取飞行器在发射系下水平面中盘旋向心加速度,即飞行器中制导指令AzO:
Az0=[1-cos(180+sigma)]/(Zt-Z)*sqrt(Vx2+Vz2);
其中,sigma为飞行器速度V的弹道偏角,Z为飞行器在发射系下的当前横向位置,Zt为飞行器完成反向180°盘旋结束点在发射系下的横向位置,Vx为飞行器速度V在发射系下X轴的投影,Vz为飞行器速度V在发射系下Z轴的投影;
S2、获取飞行器末制导指令Az1,Az1=K1(Zt-Z)-K2*Vz,其中K1为比例控制系数,K2为微分控制系数;
S3、根据飞行器中制导指令AzO和末制导指令Az1确定飞行器最终的制导指令Az,作为自动驾驶仪的输入指令从而实现飞行器的反向180°盘旋飞行:Az=(1-Lmda)*Az0+(Lmda)*Az1;
将飞行器当前位置与盘旋圆心的连线与发射系Z轴的夹角定义为圆心角:当圆心角大于15°时,过渡因子Lmda=0;当圆心角小于等于15°时,若0s≤T≤2s则过渡因子Lmda=T/2;T≥2s时过渡因子Lmda=1。
相应地,本发明还提供了一种盘旋飞行轨迹的导引律设计系统,所述系统包括依次连接的飞行器中制导指令获取模块、飞行器末制导指令获取模块和飞行器最终制导指令获取模块;
所述飞行器中制导指令获取模块用于采集飞行器的速度V、飞行器在发射系下的当前横向位置Zt以及飞行器完成反向180°盘旋结束点在发射系下的横向位置Z,获取飞行器在发射系下水平面中盘旋向心加速度,即飞行器中制导指令AzO:
Az0=[1-cos(180+sigma)]/(Zt-Z)*sqrt(Vx2+Vz2);
其中,sigma为飞行器速度V的弹道偏角,Z为飞行器在发射系下的当前横向位置,Zt为飞行器完成反向180°盘旋结束点在发射系下的横向位置,Vx为飞行器速度V在发射系下X轴的投影,Vz为飞行器速度V在发射系下Z轴的投影;
所述飞行器末制导指令获取模块用于获取飞行器末制导指令Az1,Az1=K1(Zt-Z)-K2*Vz,其中K1为比例控制系数,K2为微分控制系数;
所述飞行器最终制导指令获取模块用于根据飞行器中制导指令AzO和末制导指令Az1确定飞行器最终的制导指令Az,作为自动驾驶仪的输入指令从而实现飞行器的反向180°盘旋飞行:Az=(1-Lmda)*Az0+(Lmda)*Az1;
将飞行器当前位置与盘旋圆心的连线与发射系Z轴的夹角定义为圆心角:当圆心角大于15°时,过渡因子Lmda=0;当圆心角小于等于15°时,若0s≤T≤2s则过渡因子Lmda=T/2;T≥2s时过渡因子Lmda=1。
总体而言,通过本发明所构思的以上技术方案与现有技术相比,主要具备以下的技术优点:通过获取飞行轨迹的曲率半径,匹配速度后得到中制导指令即向心加速度导引指令,飞行器横向自动驾驶仪通过跟踪向心加速度指令从而实现180度反向盘旋飞行;通过借用直线轨迹的PD控制可实现飞行末端弹道偏角精确控制的目的,同时还可避免中制导算法在飞行器接近目标点的时间段内收敛性较差的缺陷;通过进行中、末制导指令的平滑过渡,可避免中末制导直接切换对自动驾驶仪带来的冲击。本发明方法及系统基于曲率半径与向心加速度的转换规律,具有算法简单、易于工程实现、对飞行器自动驾驶仪压力小的特点。
附图说明
图1为本发明方法工作流程图;
图2为本发明方法中制导指令生成原理图;
图3为本发明方法中飞行器180度反向盘旋纵横向位置轨迹仿真结果图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。此外,下面所描述的本发明各个实施方式中所涉及到的技术特征只要彼此之间未构成冲突就可以相互组合。
本发明导引律设计方法,主要通过获取飞行轨迹的曲率半径,匹配速度后即可得到向心加速度导引指令。横向自动驾驶仪通过跟踪该指令从而实现180°反向盘旋飞行。而纵向自动驾驶仪则可跟踪带弹道倾角约束的修正比例导引指令来实现纵向飞行。故本发明中所涉及的制导指令均为横向制导指令。
本发明导引律设计方法基于曲率半径与向心加速度的转换规律,可以非常便捷实现飞行器反向180°飞行。本发明方法具有算法简单,易于工程实现的优点。如图1所示,本发明方法主要包括三大步骤——中制导指令的实现;末制导指令的实现;最终制导指令的实现:
第一步为中制导指令的实现:该步骤利用曲率半径与向心加速度的相互关系得到中制导指令,是实现飞行器反向180°的盘旋飞行轨迹的主体部分;
第二步为末制导指令的实现,该步骤借用直线轨迹的PD控制,一方面可实现飞行末端弹道偏角精确控制的目的,另一方面还可避免中制导算法在飞行器接近目标点的时间段内收敛性较差的缺陷;
第三步为最终制导指令的实现,根据最终制导指令实现飞行器反向180°盘旋飞行,该步骤实现了中、末制导的平滑过渡,避免了中末制导直接切换带来的对自动驾驶仪的冲击。
本发明方法三个步骤具体实现方法如下:
S1、采集飞行器的速度V、飞行器在发射系下的当前横向位置Zt以及飞行器完成反向180°盘旋结束点在发射系下的横向位置Z,获取飞行器在发射系下水平面中盘旋向心加速度,即飞行器中制导指令AzO:
Az0=[1-cos(180+sigma)]/(Zt-Z)*sqrt(Vx2+Vz2);
其中,sigma为飞行器速度V的弹道偏角,Z为飞行器在发射系下的当前横向位置,Zt为飞行器完成反向180°盘旋结束点在发射系下的横向位置,Vx为飞行器速度V在发射系下X轴的投影,Vz为飞行器速度V在发射系下Z轴的投影。
S2、获取飞行器末制导指令Az1,Az1=K1(Zt-Z)-K2*Vz,其中K1为比例控制系数,K2为微分控制系数;
S3、根据飞行器中制导指令AzO和末制导指令Az1确定飞行器最终的制导指令Az,作为自动驾驶仪的输入指令从而实现飞行器的反向180°盘旋飞行:Az=(1-Lmda)*Az0+(Lmda)*Az1;
获取飞行器当前位置与盘旋圆心的连线与发射系Z轴的夹角,将其定义为圆心角;
当圆心角大于15°时,过渡因子Lmda=0;
当圆心角小于等于15°时,若0s≤T≤2s则过渡因子Lmda=T/2;T≥2s时过渡因子Lmda=1。
步骤S1~S3即实现了一种盘旋飞行轨迹的导引律设计。
如图2所示,上述步骤S1中,在侧向机动平面(发射系XOZ平面),O点为飞行器进入反向180度盘旋的初始点,C为盘旋圆心,K为完成反向180度盘旋的末尾点,V为盘旋过程中的速度矢量。则|OK|为需盘旋的横向距离,即为完成反向180度盘旋的直径,|QK|为飞行器盘旋过程中剩余的横向距离;点P为飞行器飞行的当前位置,点Q为点P在Z轴上的投影。速度V的弹道偏角sigma即为钝角QPV的负值,而圆心角alpha等于锐角QPV,即圆心角alpha=180-钝角QPV。于是得到alpha=180+sigma。故飞行器盘旋的曲率半径rho为:
rho=(Zt-Z)/[1-cos(alpha)]=(Zt-Z)/[1-cos(180+sigma)];
其中,Z为盘旋过程中飞行器在发射系的横向位置|OQ|,Zt为完成反向180度盘旋结束点的横向位置|OK|。
根据曲率计算公式可得到飞行器在发射系下XOZ平面盘旋向心加速度(即为中制导指令Az0)为:Az0=sqrt(Vx2+Vz2)/rho,其中函数sqrt(x)为开方函数。则推导可得到中制导指令Az0公式如下:
Az0=[1-cos(180+sigma)]/(Zt-Z)*sqrt(Vx2+Vz2)
上式中,Vx为飞行器速度V在发射系下X轴的投影;Vz为飞行器速度V在发射系下Z轴的投影。
中制导指令Az0可直接作为自动驾驶仪的横向过载指令,从而实现飞行器180度反向盘旋。
上述步骤S2中,获得中制导指令后,进行飞行器直线轨迹的PD(比例-微分)控制,获取末制导指令Az1=K1(Zt-Z)-K2*Vz,其中K1和K2分别为比例控制系数和微分控制系数,K1和K2可根据飞行器不同的飞行状态分别进行设计。
上述步骤S3中,进行中、末制导的平滑过渡以避免中末制导直接切换带来的对自动驾驶仪的冲击。
中、末制导的平滑过渡策略为:当圆心角alpha(角PCQ)小于15度时,开始进行过渡时间为2秒的中、末制导线性平滑过渡,此时过渡因子为:Lmda=T/2,此后T持续为2。即0s≤T≤2s时过渡因子Lmda=T/2,此时Lmda值随T值的变化而变化;T≥2s时过渡因子Lmda=1。当圆心角alpha大于15度时过渡因子Lmda持续为零。
图3为飞行器采用本发明方法生成的盘旋轨迹。由图3可知,采用本发明方法可实现飞行器反向180°盘旋,同时中、末制导过渡平滑无跳变,飞行末端弹道偏角可达到很高的约束精度。
本领域的技术人员容易理解,以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明的保护范围之内。
Claims (2)
1.一种盘旋飞行轨迹的导引律设计方法,其特征在于,所述方法包括以下步骤:
S1、采集飞行器的速度V、飞行器在发射系下的当前横向位置Zt以及飞行器完成反向180°盘旋结束点在发射系下的横向位置Z,获取飞行器在发射系下水平面中盘旋向心加速度,即飞行器中制导指令AzO:
Az0=[1-cos(180+sigma)]/(Zt-Z)*sqrt(Vx2+Vz2);
其中,sigma为飞行器速度V的弹道偏角,Z为飞行器在发射系下的当前横向位置,Zt为飞行器完成反向180°盘旋结束点在发射系下的横向位置,Vx为飞行器速度V在发射系下X轴的投影,Vz为飞行器速度V在发射系下Z轴的投影;
S2、获取飞行器末制导指令Az1,Az1=K1(Zt-Z)-K2*Vz,其中K1为比例控制系数,K2为微分控制系数;
S3、根据飞行器中制导指令AzO和末制导指令Az1确定飞行器最终的制导指令Az,作为自动驾驶仪的输入指令从而实现飞行器的反向180°盘旋飞行:Az=(1-Lmda)*Az0+(Lmda)*Az1;
将飞行器当前位置与盘旋圆心的连线与发射系Z轴的夹角定义为圆心角:当圆心角大于15°时,过渡因子Lmda=0;当圆心角小于等于15°时,若0s≤T≤2s则过渡因子Lmda=T/2;T≥2s时过渡因子Lmda=1。
2.一种盘旋飞行轨迹的导引律设计系统,其特征在于,所述系统包括依次连接的飞行器中制导指令获取模块、飞行器末制导指令获取模块和飞行器最终制导指令获取模块;
所述飞行器中制导指令获取模块用于采集飞行器的速度V、飞行器在发射系下的当前横向位置Zt以及飞行器完成反向180°盘旋结束点在发射系下的横向位置Z,获取飞行器在发射系下水平面中盘旋向心加速度,即飞行器中制导指令AzO:
Az0=[1-cos(180+sigma)]/(Zt-Z)*sqrt(Vx2+Vz2);
其中,sigma为飞行器速度V的弹道偏角,Z为飞行器在发射系下的当前横向位置,Zt为飞行器完成反向180°盘旋结束点在发射系下的横向位置,Vx为飞行器速度V在发射系下X轴的投影,Vz为飞行器速度V在发射系下Z轴的投影;
所述飞行器末制导指令获取模块用于获取飞行器末制导指令Az1,Az1=K1(Zt-Z)-K2*Vz,其中K1为比例控制系数,K2为微分控制系数;
所述飞行器最终制导指令获取模块用于根据飞行器中制导指令AzO和末制导指令Az1确定飞行器最终的制导指令Az,作为自动驾驶仪的输入指令从而实现飞行器的反向180°盘旋飞行:Az=(1-Lmda)*Az0+(Lmda)*Az1;
将飞行器当前位置与盘旋圆心的连线与发射系Z轴的夹角定义为圆心角:当圆心角大于15°时,过渡因子Lmda=0;当圆心角小于等于15°时,若0s≤T≤2s则过渡因子Lmda=T/2;T≥2s时过渡因子Lmda=1。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410453969.4A CN104298246B (zh) | 2014-09-05 | 2014-09-05 | 一种盘旋飞行轨迹的导引律设计方法及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410453969.4A CN104298246B (zh) | 2014-09-05 | 2014-09-05 | 一种盘旋飞行轨迹的导引律设计方法及系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104298246A true CN104298246A (zh) | 2015-01-21 |
CN104298246B CN104298246B (zh) | 2017-02-08 |
Family
ID=52318021
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410453969.4A Active CN104298246B (zh) | 2014-09-05 | 2014-09-05 | 一种盘旋飞行轨迹的导引律设计方法及系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104298246B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112180971A (zh) * | 2020-08-26 | 2021-01-05 | 北京理工大学 | 多旋翼飞行器多模制导方法及系统 |
CN117406763A (zh) * | 2023-08-23 | 2024-01-16 | 北京动力机械研究所 | 卫星/惯导组合式增程制导炮弹的制导方法及系统 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US3848114A (en) * | 1972-01-12 | 1974-11-12 | Sperry Rand Corp | Control system for providing a spiral flight path to a radio beacon |
EP1352206B1 (en) * | 2000-12-13 | 2005-02-09 | Saab Ab | Method for controlling a missile |
US20080243371A1 (en) * | 2005-11-15 | 2008-10-02 | Builta Kenneth E | Control System for Automatic Circle Flight |
CN101629827A (zh) * | 2009-08-14 | 2010-01-20 | 华中科技大学 | 一种飞行器前视末制导导航定位方法 |
CN102645933A (zh) * | 2012-05-02 | 2012-08-22 | 中国人民解放军海军航空工程学院 | 飞行器实现大空域机动的组合过载控制方法 |
CN102927851A (zh) * | 2012-11-20 | 2013-02-13 | 北京理工大学 | 一种基于轨迹在线规划的末制导方法 |
CN102980449A (zh) * | 2012-12-25 | 2013-03-20 | 北京理工大学 | 一种多枚导弹协同作战的控制方法 |
-
2014
- 2014-09-05 CN CN201410453969.4A patent/CN104298246B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US3848114A (en) * | 1972-01-12 | 1974-11-12 | Sperry Rand Corp | Control system for providing a spiral flight path to a radio beacon |
EP1352206B1 (en) * | 2000-12-13 | 2005-02-09 | Saab Ab | Method for controlling a missile |
US20080243371A1 (en) * | 2005-11-15 | 2008-10-02 | Builta Kenneth E | Control System for Automatic Circle Flight |
CN101629827A (zh) * | 2009-08-14 | 2010-01-20 | 华中科技大学 | 一种飞行器前视末制导导航定位方法 |
CN102645933A (zh) * | 2012-05-02 | 2012-08-22 | 中国人民解放军海军航空工程学院 | 飞行器实现大空域机动的组合过载控制方法 |
CN102927851A (zh) * | 2012-11-20 | 2013-02-13 | 北京理工大学 | 一种基于轨迹在线规划的末制导方法 |
CN102980449A (zh) * | 2012-12-25 | 2013-03-20 | 北京理工大学 | 一种多枚导弹协同作战的控制方法 |
Non-Patent Citations (2)
Title |
---|
YANG HE 等: "A theory and algorithm for the computer simulation of the adjusting and controlling of the spiral flight-rolling process", 《JOURNAL OF MATERIALS PROCESSING TECHNOLOGY》 * |
奚盛海 等: "末端制导飞行轨迹的仿真与试飞", 《北京航空航天大学学报》 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112180971A (zh) * | 2020-08-26 | 2021-01-05 | 北京理工大学 | 多旋翼飞行器多模制导方法及系统 |
CN117406763A (zh) * | 2023-08-23 | 2024-01-16 | 北京动力机械研究所 | 卫星/惯导组合式增程制导炮弹的制导方法及系统 |
Also Published As
Publication number | Publication date |
---|---|
CN104298246B (zh) | 2017-02-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Bouabdallah | Design and control of quadrotors with application to autonomous flying | |
CN109359408B (zh) | 一种空面导弹控制全流程仿真系统及方法 | |
CN105353621B (zh) | 一种地球静止轨道卫星电推力器故障模式推力分配方法 | |
Wang et al. | Entry trajectory planning with terminal full states constraints and multiple geographic constraints | |
CN101794154A (zh) | 一种编队卫星相对轨道与姿态解耦控制方法 | |
CN108594639A (zh) | 一种基于强化学习的全垫升气垫船航迹跟踪控制方法 | |
CN107300386B (zh) | 一种基于仅测角导航的闭环凸优化最优交会制导方法 | |
CN109613928B (zh) | 一种用于多矢量螺旋桨组合浮空器的复合控制系统及方法 | |
CN112061424B (zh) | 一种基于融合目标姿态的机动过程能源角动态跟踪方法 | |
CN109857130A (zh) | 一种基于误差四元数的导弹双回路姿态控制方法 | |
CN104443432A (zh) | 一种卫星有限推力共面圆轨道自主轨道转移制导方法 | |
CN103808323A (zh) | 一种卫星姿态跟踪机动的余弦过渡加速度路径方法 | |
CN103253382B (zh) | 一种高精度发动机联合变轨方法 | |
CN101694364A (zh) | 摄动制导与迭代制导的快速转换方法 | |
CN104298246A (zh) | 一种盘旋飞行轨迹的导引律设计方法及系统 | |
CN113859584B (zh) | 一种漂旋目标分布式接管的抵近轨迹规划方法 | |
CN107117334B (zh) | 一种小天体表面移动探测制导方法 | |
CN109774977B (zh) | 一种基于四元数的时间最优的卫星姿态快速机动方法 | |
CN107678442A (zh) | 一种基于双模型下的四旋翼自主着船控制方法 | |
CN103853047B (zh) | 一种基于状态量反馈的小推力跟踪制导方法 | |
CN107918400B (zh) | 一种空天飞行器在轨操作相对位置姿态联合控制方法 | |
CN112947073A (zh) | 一种基于模型预测控制的舰载机滑行轨迹跟踪方法 | |
Yanhui et al. | Flight control system simulation platform for UAV based on integrating simulink with stateflow | |
CN106021835A (zh) | 一种面向最优侦察的航迹设计方法 | |
CN109165415A (zh) | 一种基于人工合成引力势场的连续推力轨道设计方法及其应用 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |