CN111649734A - 一种基于粒子群算法的捷联导引头目标定位方法 - Google Patents
一种基于粒子群算法的捷联导引头目标定位方法 Download PDFInfo
- Publication number
- CN111649734A CN111649734A CN202010532068.XA CN202010532068A CN111649734A CN 111649734 A CN111649734 A CN 111649734A CN 202010532068 A CN202010532068 A CN 202010532068A CN 111649734 A CN111649734 A CN 111649734A
- Authority
- CN
- China
- Prior art keywords
- angle
- particle
- guided bomb
- bomb
- target
- 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
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/005—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 with correlation of navigation data from several sources, e.g. map or contour matching
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Aiming, Guidance, Guns With A Light Source, Armor, Camouflage, And Targets (AREA)
Abstract
一种基于粒子群算法的捷联导引头目标定位方法,属于制导与控制技术领域。本发明是为了解决直瞄状态下装备捷联导引头进行末制导,导引头工作一定时间后出现故障或者被干扰,无法提供制导信息时,直瞄初始装订目标误差较大而导致目标打击精度差的问题。此方法首先记录一段时间内,导引头所测的制导炸弹的体视线角信息及同步的制导炸弹的位置信息和姿态角信息;然后基于粒子群算法,设置合适的参数并初始化粒子种群,通过粒子的位置和记录的制导炸弹不同时刻的位置信息和姿态角信息,求解出对应的制导炸弹的体视线角,以记录的体视线角与计算得到的体视线角误差作为适应函数,迭代求解出目标位置,作为后续导引头故障后的制导目标。
Description
技术领域
本发明涉及一种基于粒子群算法的捷联导引头目标定位方法,属于制导与控制技术领域。
背景技术
一般飞机作战,采用飞机的激光瞄准吊舱,直接对目标进行直瞄计算,给定目标的经纬度信息,再转发给制导炸弹进行目标打击。直瞄精度由吊舱精度和算法精度直接影响。
针对直瞄状态下,装备全捷联激光导引头进行末制导时,如果在导引头工作一定时间之后,导引头出故障或者被干扰,无法提供制导信息,制导炸弹只能以直瞄装订的目标位置采用卫星制导,炸弹的命中精度将接近目标直瞄的精度,难以满足打击精度要求。如果采用一定的算法,根据导引头工作时间内的导引头信息,来再次对目标定位,可以降低目标位置估计误差,提高命中精度。目前较为常用的方法是利用EKF等滤波方法建立状态方程和观测方程来对目标位置进行估计,此方法目前存在两个问题,一是滤波收敛需要时间,二是由于导引头只能提供方向信息而没有角度信息,因此通过滤波定位精度较差,难以进行工程应用。
发明内容
本发明目的是为了解决捷联导引头出现故障或者被干扰,无法提供制导信息的问题,提供了一种基于粒子群算法的捷联导引头目标定位方法,所采取的技术方案如下:
一种基于粒子群算法的捷联导引头目标定位方法,包括以下步骤:
步骤一:记录一段时间之内,导引头所测的制导炸弹体视线角信息qα,qβ,其中,qα,qβ分别代表制导炸弹的体视线高低角和方位角;同时,需要记录同步的制导炸弹的位置信息xd,yd,zd和姿态角信息ψ,γ,其中,ψ,γ分别代表制导炸弹的偏航角、俯仰角、滚转角;
步骤二:对粒子群的种群进行初始化,粒子群的数目根据记录数据包数和取值空间设置,粒子群算法的求解变量为目标位置xt,yt,zt,采用均匀分布概率函数对3个变量进行采样,取值空间为直瞄精度;
步骤三:利用采用的粒子的目标位置xt,yt,zt和制导炸弹不同时刻的位置信息xd,yd,zd,求解出制导炸弹的视线角qγ,qλ,qγ,qλ分别代表制导炸弹视线高低角和方位角;再根据视线角qγ,qλ和制导炸弹的姿态角ψ,γ,求解出制导炸弹体视线角
步骤四:根据平均视线角误差建立适应度函数,更新每个粒子的速度和位置;
步骤五:重复步骤三、四,适应度最高的粒子即为目标位置。
本发明的优点:
本发明提出了一种基于粒子群算法的捷联导引头目标定位方法。该方法针对直瞄状态下,装备全捷联激光导引头进行末制导时,在导引头工作一定时间之后,导引头出故障或者被干扰,无法提供制导信息时,直瞄初始装订目标误差较大而导致目标打击精度差的问题,利用之前所保存的导引头所测的制导炸弹的体视线角、制导炸弹位置、制导炸弹姿态角信息,以平均视线角误差作为适应函数,运用粒子群算法来对目标进行定位。相对于传统的运用EKF、UKF等滤波算法来进行目标定位,本发明成功解决两个问题:一是滤波收敛需要时间,在导引头工作时间内,滤波算法难以保证快速可靠收敛;二是由于导引头只提供角度信息而没有距离信息,属于单弹无源定位范畴,要对固定目标进行定位,制导炸弹须做一定的机动,且制导炸弹速度垂直于弹目连线效果最佳,而实际往往不能满足此条件。本发明可以很好的避免这两种情况,定位精度远高于传统的滤波定位方法。
附图说明
图1是本发明所述基于粒子群算法的捷联导引头目标定位方法流程图。
具体实施方式
具体实施方式一
下面结合图1说明本实施方式,本实施方式所述基于粒子群算法的捷联导引头目标定位方法包括以下步骤:
步骤一:记录一段时间之内,导引头所测的制导炸弹体视线角信息qα,qβ,其中,qα,qβ分别代表制导炸弹的体视线高低角和方位角;同时,需要记录同步的制导炸弹的位置信息xd,yd,zd和姿态角信息ψ,γ,其中,ψ,γ分别代表制导炸弹的偏航角、俯仰角、滚转角;
步骤二:对粒子群的种群进行初始化。粒子群的数目根据记录数据包数和取值空间设置,粒子群算法的求解变量为目标位置xt,yt,zt。采用均匀分布概率函数对3个变量进行采样,取值空间为直瞄精度;
步骤三:利用采用的粒子的目标位置xt,yt,zt和制导炸弹不同时刻的位置信息xd,yd,zd,求解出制导炸弹的视线角qγ,qλ,qγ,qλ分别代表制导炸弹视线高低角和方位角;再根据视线角qγ,qλ和制导炸弹的姿态角信息ψ,γ,求解出制导炸弹的体视线角
步骤四:根据平均视线角误差建立适应度函数,计算每个粒子的适应度并更新粒子的速度和位置。
步骤五:重复步骤三、四直到完成最大迭代次数N,适应度最高的粒子即为目标位置。
本实施方式中,最终Pglobal即目标定位结果。
具体实施方式二
本实施方式对具体实施方式一做进一步说明:
步骤一所述qα,qβ定义如下:
制导炸弹姿态角定义如下:
偏航角:制导炸弹纵轴在水平面内投影与地面系X轴之间的夹角。
俯仰角:制导炸弹纵轴与水平面之间的夹角。
滚转角:弹体坐标系的Y轴与包含制导炸弹纵轴的铅锤面之间的夹角。
进一步的,步骤二中粒子种群初始化过程为:
第一步:设置粒子数目。
第二步:设置惯性因子ω。
第三步:设置个体学习因子c1和社会学习因子c2。
第四步:设置粒子最大飞翔速度Vmax。
第五步:设置最大迭代次数N。
第六步:采用均匀分布概率函数生成粒子及初始化粒子速度。
进一步的,步骤三中制导炸弹的视线角qγ,qλ与粒子和制导炸弹的位置坐标关系如下:
其中
xi,yi,zi为第i个粒子的位置坐标。
考虑弹目矢量方向的单位矢量,制导炸弹的视线角与体视线角存在如下关系:
其中
则
其中,Cij代表坐标系变换矩阵C中第i行第j列元素。
进一步的,步骤四中适应度函数的选取准则为:粒子坐标与制导炸弹坐标及制导炸弹姿态角计算得到的弹目连线方向单位矢量与记录的体视线角计算得到的弹目连线方向单位矢量vj的夹角Δθ越小,则适应度越高。对应n组数据,则平均值越小,粒子适应度越高。所以可将此结果取倒数作为粒子适应度。表达式如下:
粒子位置更新算法如下:
考虑到粒子最大速度有:
粒子位置更新:
Pi=Pi+Vi⑾
Pglobal更新方法如下:
进一步的,步骤五中,重复步骤三、四,直到完成最大迭代次数N,Pglobal即为最优结果。
本发明针对直瞄状态下装备捷联导引头进行末制导,捷联导引头工作一定时间后出现故障或者被干扰,无法提供制导信息时,直瞄初始装订目标误差较大而导致目标打击精度差的问题,提供了一种基于粒子群算法的捷联导引头目标定位方法,有效解决了导引头开机时间短可能导致的传统滤波定位算法不收敛以及单弹无源定位的不准确性,提高了目标定位精度。
虽然本发明已以较佳的实施例公开如上,但其并非用以限定本发明,任何熟悉此技术的人,在不脱离本发明的精神和范围内,都可以做各种改动和修饰,因此本发明的保护范围应该以权利要求书所界定的为准。
Claims (7)
1.一种基于粒子群算法的捷联导引头目标定位方法,其特征在于,包括以下步骤:
步骤一:记录一段时间之内,导引头所测的制导炸弹体视线角信息qα,qβ,其中,qα,qβ分别代表制导炸弹的体视线高低角和方位角;同时,需要记录同步的制导炸弹的位置信息xd,yd,zd和姿态角信息ψ,γ,其中,ψ,γ分别代表制导炸弹的偏航角、俯仰角、滚转角;
步骤二:对粒子群的种群进行初始化,粒子群的数目根据记录数据包数和取值空间设置,粒子群算法的求解变量为目标位置xt,yt,zt,采用均匀分布概率函数对3个变量进行采样,取值空间为直瞄精度;
步骤三:利用采用的粒子的目标位置xt,yt,zt和制导炸弹不同时刻的位置信息xd,yd,zd,求解出制导炸弹的视线角qγ,qλ,qγ,qλ分别代表制导炸弹视线高低角和方位角;再根据视线角qγ,qλ和制导炸弹的姿态角ψ,γ,求解出制导炸弹体视线角
步骤四:根据平均视线角误差建立适应度函数,更新每个粒子的速度和位置;
步骤五:重复步骤三、四,适应度最高的粒子即为目标位置。
3.根据权利要求1所述的一种基于粒子群算法的捷联导引头目标定位方法,其特征在于:步骤一中,制导炸弹姿态角定义如下:
偏航角:制导炸弹纵轴在水平面内投影与地面系X轴之间的夹角;
俯仰角:制导炸弹纵轴与水平面之间的夹角;
滚转角:弹体坐标系的Y轴与包含制导炸弹纵轴的铅锤面之间的夹角。
4.根据权利要求1所述一种基于粒子群算法的捷联导引头目标定位方法,其特征在于:所述步骤二中,粒子种群初始化过程为:
第一步:设置粒子数目;
第二步:设置惯性因子ω;
第三步:设置个体学习因子c1和社会学习因子c2;
第四步:设置粒子最大飞翔速度Vmax;
第五步:设置最大迭代次数N;
第六步:采用均匀分布概率函数生成粒子及初始化粒子速度。
6.根据权利要求1所述一种基于粒子群算法的捷联导引头目标定位方法,其特征在于:步骤四中适应度函数的选取准则为:粒子坐标与制导炸弹坐标及制导炸弹姿态角计算得到的弹目连线方向单位矢量与记录的体视线角计算得到的弹目连线方向单位矢量vj的夹角Δθ越小,则适应度越高,对应n组数据,则平均值越小,粒子适应度越高,所以将此结果取倒数作为粒子适应度,表达式如下:
粒子位置更新算法如下:
考虑到粒子最大速度有:
粒子位置更新:
Pi=Pi+Vi ⑾
Pglobal更新方法如下:
7.根据权利要求6所述一种基于粒子群算法的捷联导引头目标定位方法,其特征在于:所述步骤五中,重复步骤三和步骤四,直到完成最大迭代次数N,Pglobal即为最优结果。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010532068.XA CN111649734B (zh) | 2020-06-11 | 2020-06-11 | 一种基于粒子群算法的捷联导引头目标定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010532068.XA CN111649734B (zh) | 2020-06-11 | 2020-06-11 | 一种基于粒子群算法的捷联导引头目标定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111649734A true CN111649734A (zh) | 2020-09-11 |
CN111649734B CN111649734B (zh) | 2021-03-23 |
Family
ID=72341226
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010532068.XA Active CN111649734B (zh) | 2020-06-11 | 2020-06-11 | 一种基于粒子群算法的捷联导引头目标定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111649734B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112880704A (zh) * | 2021-01-19 | 2021-06-01 | 中国人民解放军海军工程大学 | 光纤陀螺捷联惯导系统智能标定方法 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103822636A (zh) * | 2014-03-18 | 2014-05-28 | 中国航天时代电子公司 | 一种空对地制导武器捷联寻的视线重构方法 |
CN105021092A (zh) * | 2015-06-30 | 2015-11-04 | 北京航天长征飞行器研究所 | 一种捷联寻的导引头的制导信息提取方法 |
CN105486308A (zh) * | 2015-11-25 | 2016-04-13 | 哈尔滨工业大学 | 估计弹目视线角速率的快收敛Kalman滤波器的设计方法 |
CN106949894A (zh) * | 2017-04-13 | 2017-07-14 | 山东科技大学 | 一种用于无人机自动避撞的最优常值导引指令求解方法 |
CN107255924A (zh) * | 2017-06-14 | 2017-10-17 | 哈尔滨工业大学 | 基于扩维模型的容积卡尔曼滤波提取捷联导引头制导信息的方法 |
US10077971B1 (en) * | 2008-07-07 | 2018-09-18 | Lockheed Martin Corporation | Risley prism line-of-sight control for strapdown missile |
CN110008502A (zh) * | 2019-01-29 | 2019-07-12 | 西北工业大学 | 考虑全捷联导引头视场约束的三维制导控制一体化设计方法 |
-
2020
- 2020-06-11 CN CN202010532068.XA patent/CN111649734B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US10077971B1 (en) * | 2008-07-07 | 2018-09-18 | Lockheed Martin Corporation | Risley prism line-of-sight control for strapdown missile |
CN103822636A (zh) * | 2014-03-18 | 2014-05-28 | 中国航天时代电子公司 | 一种空对地制导武器捷联寻的视线重构方法 |
CN105021092A (zh) * | 2015-06-30 | 2015-11-04 | 北京航天长征飞行器研究所 | 一种捷联寻的导引头的制导信息提取方法 |
CN105486308A (zh) * | 2015-11-25 | 2016-04-13 | 哈尔滨工业大学 | 估计弹目视线角速率的快收敛Kalman滤波器的设计方法 |
CN106949894A (zh) * | 2017-04-13 | 2017-07-14 | 山东科技大学 | 一种用于无人机自动避撞的最优常值导引指令求解方法 |
CN107255924A (zh) * | 2017-06-14 | 2017-10-17 | 哈尔滨工业大学 | 基于扩维模型的容积卡尔曼滤波提取捷联导引头制导信息的方法 |
CN110008502A (zh) * | 2019-01-29 | 2019-07-12 | 西北工业大学 | 考虑全捷联导引头视场约束的三维制导控制一体化设计方法 |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112880704A (zh) * | 2021-01-19 | 2021-06-01 | 中国人民解放军海军工程大学 | 光纤陀螺捷联惯导系统智能标定方法 |
Also Published As
Publication number | Publication date |
---|---|
CN111649734B (zh) | 2021-03-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108279005B (zh) | 一种导引头数据失效模式下的制导信息重构方法 | |
CN105180728B (zh) | 基于前数据的旋转制导炮弹快速空中对准方法 | |
CN105486308B (zh) | 估计弹目视线角速率的快收敛Kalman滤波器的设计方法 | |
CN113642122B (zh) | 基于单面射表的远程拦截发射诸元获取方法及系统 | |
CN111366148B (zh) | 适用于机载光电观瞄系统多次观察的目标定位方法 | |
CN104932535B (zh) | 利用仿真系统对机载前视红外搜索设备闭环测试的方法 | |
CN107478110B (zh) | 一种基于状态观测器的旋转弹姿态角计算方法 | |
CN105115508A (zh) | 基于后数据的旋转制导炮弹快速空中对准方法 | |
CN115248038B (zh) | 一种发射系下的sins/bds组合导航工程算法 | |
CN111238474A (zh) | 基于倾斜坐标系的捷联导引头非奇异视线角速度提取方法 | |
CN114020021B (zh) | 一种多导弹分布式协同制导律的设计方法及系统 | |
CN111649734B (zh) | 一种基于粒子群算法的捷联导引头目标定位方法 | |
CN115033024A (zh) | 基于攻击时间和角度共同约束的多导弹三维协同制导方法 | |
CN117455960B (zh) | 时变观测噪声条件下机载光电系统对地无源定位滤波方法 | |
CN108106597B (zh) | 全捷联激光导引头在目标出线性视场情况下角度测量方法 | |
CN111026139B (zh) | 一种基于飞行轨迹的三维模型姿态调整控制方法 | |
CN114935277B (zh) | 一种滑翔增程制导炮弹理想弹道的在线规划方法 | |
CN116294811A (zh) | 基于多目标狼群算法的武装直升机火飞协同机制分析方法 | |
CN115388890A (zh) | 基于视觉的多无人机协同对地目标定位方法 | |
CN109376364A (zh) | 基于扩展卡尔曼滤波的高速旋转弹气动参数辨识方法 | |
CN114967735A (zh) | 一种多ucav协同实时航迹规划方法 | |
CN113176563A (zh) | 一种雷达景象匹配末制导导弹飞行弹道规划方法 | |
CN114440707A (zh) | 顶部与侧面协同拦截的飞行器制导方法、装置及系统 | |
CN114153143A (zh) | 一种导弹非奇异固定时间滑模制导律的设计方法 | |
CN113031645B (zh) | 一种基于ukf滤波的弹体角速率增稳捷联制导方法 |
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 |