CN105629282A - 自行防空武器的组合导航方法 - Google Patents
自行防空武器的组合导航方法 Download PDFInfo
- Publication number
- CN105629282A CN105629282A CN201510975438.6A CN201510975438A CN105629282A CN 105629282 A CN105629282 A CN 105629282A CN 201510975438 A CN201510975438 A CN 201510975438A CN 105629282 A CN105629282 A CN 105629282A
- Authority
- CN
- China
- Prior art keywords
- latitude
- longitude
- navigation
- satellite
- coordinate
- 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
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/42—Determining position
- G01S19/45—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
- G01S19/47—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement the supplementary measurement being an inertial measurement, e.g. tightly coupled inertial
-
- 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
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/01—Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/13—Receivers
- G01S19/14—Receivers specially adapted for specific applications
- G01S19/18—Military applications
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Automation & Control Theory (AREA)
- Navigation (AREA)
Abstract
本发明属于自行防空武器的惯性/航位推算/卫星导航技术领域,具体涉及一种自行防空武器的组合导航方法。本发明利用航位推算的导航坐标进行经纬度数据推算,为武器系统复杂电磁环境下信息化作战、指挥提供自主、多元的导航信息。本发明对卫星接收机的经纬度和起始点经纬度进行高斯投影正算来获取平面坐标相对变化量,再与导航坐标相对变化量作比较能够判断卫星接收机的经纬度真实性和准确性,排除卫星经纬度数据中的异常值和虚假值。
Description
技术领域
本发明属于自行防空武器的惯性/航位推算/卫星导航技术领域,具体涉及一种自行防空武器的组合导航方法。
背景技术
我国现役的自行防空武器的导航系统多采用平台式惯导/航位推算/卫星导航的方式,其工作流程为:首先进行停止间初始对准,获取初始航向与姿态,设置出发地坐标,以正北向为X轴,以正东向为Y轴二维平面坐标系,之后进入航向保持状态,车辆开始行进。在车辆行进中导航系统给出车辆的当前航向角、姿态量、导航坐标XY以及经纬度数据。其中,导航坐标XY是基于底盘的里程信号、航向角和姿态量的航位推算所得;而经纬度数据直接源于卫星接收机。在现代信息化作战要求下,武器平台的多以经纬度或坐标形式展示的定位信息是实现连排内、上下级以及友邻间战场信息综合、共享和发布的基础,而在现代战争复杂电磁环境条件下卫星接收机极有可能被敌方干扰、压制甚至欺骗。有鉴于此,在使用卫星接收机的经纬度数据之前有必要对其真实性和准确性做出判定。
发明内容
(一)要解决的技术问题
本发明要解决的技术问题是:第一个技术问题是,导航系统如何利用航位推算的导航坐标获取惯导经纬度数据;第二个技术问题是,导航系统如何对卫星接收机的经纬度数据的真实性和准确性做出判定。
(二)技术方案
为解决上述技术问题,本发明提供一种自行防空武器的组合导航方法,该方法包括如下步骤:
步骤1:获取起始点经纬度和高程的步骤;
步骤2:利用导航坐标推算经纬度和里程的步骤;
步骤3:对卫星接收机的经纬度数据的真实性和准确性做出判定的步骤;
其中,所述步骤1通过两种方式来实施;第一种是由人工通过人机界面进行装定,第二种是自动从卫星定位数据中解析获取,第一种方式的优先级高于第二种方式;
所述步骤2为:定时计算当前导航坐标(Xi,Yi)相对于前一时刻导航坐标的坐标变化量(ΔXi(k),ΔYi(k)),之后将坐标变化量转化为经纬度的变化量(ΔBi(k),ΔLi(k))并进行积分以得到惯导经纬度(Bi,Li);同坐标变化量将(ΔXi(k),ΔYi(k))转化里程变化量(ΔSi(k))并进行积分以得到里程(Si);
所述步骤3为:对当前卫星接收机的经纬度(Bwx,Lwx)和起始点经纬度(B0,L0)分别利用高斯投影正算(B,L→X,Y)转化为平面坐标(Xwx,Ywx)和(X0,Y0),之后两者作差可得卫星数据坐标变化量(ΔXwx,ΔYwx),同时计算航位推算的导航坐标的变化量(ΔXi,ΔYi),求卫星数据坐标与导航坐标的变化量偏差ΔR,设惯导的定位精度指标为p*D,其中,D为所行驶的里程,p为标量如2%、4‰,如果ΔR小于等于3*p*Si,Si为行驶里程,则判定卫星经纬度可信和准确,可以使用,否则判定卫星经纬度不可信和不准确,不能使用。
(三)有益效果
与现有技术相比较,本发明具备如下有益效果:
(1)本发明利用航位推算的导航坐标进行经纬度数据推算,为武器系统复杂电磁环境下信息化作战、指挥提供自主、多元的导航信息。
(2)本发明对卫星接收机的经纬度和起始点经纬度进行高斯投影正算来获取平面坐标相对变化量,再与导航坐标相对变化量作比较能够判断卫星接收机的经纬度真实性和准确性,排除卫星经纬度数据中的异常值和虚假值。
附图说明
图1是本发明惯导经纬度和里程计算流程示意图。
图2是本发明卫星经纬度数据判定流程示意图。
具体实施方式
为使本发明的目的、内容、和优点更加清楚,下面结合附图和实施例,对本发明的具体实施方式作进一步详细描述。
为解决现有技术的问题,本发明提供一种自行防空武器的组合导航方法,该方法包括如下步骤:
步骤1:获取起始点经纬度和高程的步骤;
步骤2:利用导航坐标推算经纬度和里程的步骤;
步骤3:对卫星接收机的经纬度数据的真实性和准确性做出判定的步骤;
其中,所述步骤1通过两种方式来实施;第一种是由人工通过人机界面进行装定,第二种是自动从卫星定位数据中解析获取,第一种方式的优先级高于第二种方式;
所述步骤2为:定时计算当前导航坐标(Xi,Yi)相对于前一时刻导航坐标的坐标变化量(ΔXi(k),ΔYi(k)),之后将坐标变化量转化为经纬度的变化量(ΔBi(k),ΔLi(k))并进行积分以得到惯导经纬度(Bi,Li);同坐标变化量将(ΔXi(k),ΔYi(k))转化里程变化量(ΔSi(k))并进行积分以得到里程(Si);
所述步骤3为:对当前卫星接收机的经纬度(Bwx,Lwx)和起始点经纬度(B0,L0)分别利用高斯投影正算(B,L→X,Y)转化为平面坐标(Xwx,Ywx)和(X0,Y0),之后两者作差可得卫星数据坐标变化量(ΔXwx,ΔYwx),同时计算航位推算的导航坐标的变化量(ΔXi,ΔYi),求卫星数据坐标与导航坐标的变化量偏差ΔR,设惯导的定位精度指标为p*D,其中,D为所行驶的里程,p为标量如2%、4‰,如果ΔR小于等于3*p*Si,Si为行驶里程,则判定卫星经纬度可信和准确,可以使用,否则判定卫星经纬度不可信和不准确,不能使用。
下面结合具体实施例来详细描述本发明。
实施例
本优选实施例设定惯导精度为1.5%D,卫星定位精度10米的组合导航系统。
该优选实施例包括获取起始点经纬度和高程环节、利用导航坐标推算经纬度和里程环节和对卫星接收机的经纬度数据的真实性和准确性做出判定环节。所述获取起始点经纬度和高程环节采取两种方式:第一种是由人工通过上位机或人机界面装定,装定的经纬度数据精度为0.001分,高程精度5米;第二种是自动从卫星定位数据中解析获取,一种可行的方法是连续接收3组经纬度和高程数据(因为车辆为停止间,卫星数据变化不大),之后对比这3组数据,如果其经度偏差和纬度偏差均小于0.001分且高程偏差小于5米则取3组数据的平均值赋予起始点,否则再次连续接收3组数据进行判断,直到满足要求为止。第一种方式的优先级高于第二种方式,即使系统已经自动获取起始点经纬度和高程数据,依然可以进行人工装定。
所述利用导航坐标推算经纬度和里程环节每秒钟推算1次,具体算法如下:
导航坐标和里程变化量计算公式:
ΔXi(k+1)=Xi(k+1)-Xi(k)(1)
ΔYi(k+1)=Yi(k+1)-Yi(k)(2)
惯导经纬度和里程计算公式:
Si(k+1)=Si(k)+ΔSi(k+1)(8)
式(1)~(8)中,k=0,1,2,3…,下标i表示惯导,惯导坐标X向正北为正,惯导坐标Y向正东为正,S为里程,B为纬度,L为经度,RM为子午圈曲率半径,RN为卯酉圈曲率半径,H为高程,C=6399593.625864为极曲率半径,e'=6.739496775479E-03为第二偏心率,地球数学模型为CGCS2000国家坐标系椭球。
所述对卫星接收机的经纬度数据的真实性和准确性做出判定环节主要算法是高斯投影正算和卫星与惯导偏差计算。所谓高斯投影就是按照高斯投影条件(①正形条件,②中央子午线投影后为直线,③中央子午线投影后长度不变)把参考椭球面展成平面。为缩小投影变形,高斯投影必须分带进行,我国规定按照经差6°或3°投影。为缩小投影变形以及克服坐标换带问题,本发明中高斯投影以经过起始点的子午线为中央子午线,高斯投影的坐标原点O在中央子午线与赤道的交点上。高斯投影正算(B,L→x,y)公式如下:
式(9)~(11)中,C0=6367449.145771,C1=32009.818687,
C2=133.959891,C3=0.697551,C4=0.00394为CGCS2000国家坐标系椭球子午线弧长乘方型公式参数;t=tan(B);m0=l"cos(B)/ρ",经差l"=(L-L0)以角秒为单位,L为当前点经度,L0为起始点经度,ρ"=206264.8062471;η2=e'2cos2(B),e'=6.739496775479E-03为第二偏心率;计算结果x和y为自然坐标。
在北纬20°至53°东经70°至135°范围内,自行防空武器300km作战半径内,对高斯投影正算进行适当简化:
将简化的高斯投影正算式(9’)~(11’)记为:
则对当前卫星经纬度和起始点经纬度进行简化高斯投影正算,再对二者投影结果做差,可计算出卫星数据的平面坐标相对变化为:
式(13)中,下标wx表示卫星,下标0表示起始点。与原算法相比,虽然会引入不超过万分之一的转换误差(对导航系统而言完全可接受),但是明显减少了运算,减轻导航计算机运行压力,而且实际中对起始点经纬度进行高斯投影正算只需计算一次。而惯导平面坐标相对变化为:
进一步计算出卫星数据的平面坐标相对变化与惯导平面坐标相对变化的偏差(简称卫星与惯导偏差):
卫星经纬度数据真实性和准确性判定准则:如果ΔR小于等于3*p*S(p为惯导精度,此例取值0.015,S(k)为行驶里程,以米为单位)则判定卫星经纬度可信和准确,可以使用;否则判定卫星经纬度不准确和不可信,不能使用。
以上所述仅是本发明的优选实施方式,应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明技术原理的前提下,还可以做出若干改进和变形,这些改进和变形也应视为本发明的保护范围。
Claims (1)
1.一种自行防空武器的组合导航方法,其特征在于,该方法包括如下步骤:
步骤1:获取起始点经纬度和高程的步骤;
步骤2:利用导航坐标推算经纬度和里程的步骤;
步骤3:对卫星接收机的经纬度数据的真实性和准确性做出判定的步骤;
其中,所述步骤1通过两种方式来实施;第一种是由人工通过人机界面进行装定,第二种是自动从卫星定位数据中解析获取,第一种方式的优先级高于第二种方式;
所述步骤2为:定时计算当前导航坐标(Xi,Yi)相对于前一时刻导航坐标的坐标变化量(ΔXi(k),ΔYi(k)),之后将坐标变化量转化为经纬度的变化量(ΔBi(k),ΔLi(k))并进行积分以得到惯导经纬度(Bi,Li);同坐标变化量将(ΔXi(k),ΔYi(k))转化里程变化量(ΔSi(k))并进行积分以得到里程(Si);
所述步骤3为:对当前卫星接收机的经纬度(Bwx,Lwx)和起始点经纬度(B0,L0)分别利用高斯投影正算(B,L→X,Y)转化为平面坐标(Xwx,Ywx)和(X0,Y0),之后两者作差可得卫星数据坐标变化量(ΔXwx,ΔYwx),同时计算航位推算的导航坐标的变化量(ΔXi,ΔYi),求卫星数据坐标与导航坐标的变化量偏差ΔR,设惯导的定位精度指标为p*D,其中,D为所行驶的里程,p为标量如2%、4‰,如果ΔR小于等于3*p*Si,Si为行驶里程,则判定卫星经纬度可信和准确,可以使用,否则判定卫星经纬度不可信和不准确,不能使用。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510975438.6A CN105629282B (zh) | 2015-12-22 | 2015-12-22 | 自行防空武器的组合导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510975438.6A CN105629282B (zh) | 2015-12-22 | 2015-12-22 | 自行防空武器的组合导航方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105629282A true CN105629282A (zh) | 2016-06-01 |
CN105629282B CN105629282B (zh) | 2018-08-24 |
Family
ID=56044394
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510975438.6A Expired - Fee Related CN105629282B (zh) | 2015-12-22 | 2015-12-22 | 自行防空武器的组合导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105629282B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106980134A (zh) * | 2017-03-07 | 2017-07-25 | 广州汽车集团股份有限公司 | 智能车长隧道出口gps漂移路段控制系统及方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2005070127A2 (en) * | 2004-01-22 | 2005-08-04 | Trimble Navigation Ltd. | Method and apparatus for steering movable object by using control algorithm |
CN101256080A (zh) * | 2008-04-09 | 2008-09-03 | 南京航空航天大学 | 卫星/惯性组合导航系统的空中对准方法 |
CN103487822A (zh) * | 2013-09-27 | 2014-01-01 | 南京理工大学 | 北斗/多普勒雷达/惯性自主式组合导航系统及其方法 |
CN104181574A (zh) * | 2013-05-25 | 2014-12-03 | 成都国星通信有限公司 | 一种捷联惯导系统/全球导航卫星系统组合导航滤波系统及方法 |
CN105241456A (zh) * | 2015-11-06 | 2016-01-13 | 金陵科技学院 | 巡飞弹高精度组合导航方法 |
-
2015
- 2015-12-22 CN CN201510975438.6A patent/CN105629282B/zh not_active Expired - Fee Related
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2005070127A2 (en) * | 2004-01-22 | 2005-08-04 | Trimble Navigation Ltd. | Method and apparatus for steering movable object by using control algorithm |
CN101256080A (zh) * | 2008-04-09 | 2008-09-03 | 南京航空航天大学 | 卫星/惯性组合导航系统的空中对准方法 |
CN104181574A (zh) * | 2013-05-25 | 2014-12-03 | 成都国星通信有限公司 | 一种捷联惯导系统/全球导航卫星系统组合导航滤波系统及方法 |
CN103487822A (zh) * | 2013-09-27 | 2014-01-01 | 南京理工大学 | 北斗/多普勒雷达/惯性自主式组合导航系统及其方法 |
CN105241456A (zh) * | 2015-11-06 | 2016-01-13 | 金陵科技学院 | 巡飞弹高精度组合导航方法 |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106980134A (zh) * | 2017-03-07 | 2017-07-25 | 广州汽车集团股份有限公司 | 智能车长隧道出口gps漂移路段控制系统及方法 |
Also Published As
Publication number | Publication date |
---|---|
CN105629282B (zh) | 2018-08-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US20130325222A1 (en) | Automatic recovery method for an unmanned aerial vehicle | |
CN107389064A (zh) | 一种基于惯性导航的无人车变道控制方法 | |
CN104390646B (zh) | 水下潜器地形辅助惯性导航系统的位置匹配方法 | |
CN107966156A (zh) | 一种适用于运载火箭垂直回收段的制导律设计方法 | |
RU2487419C1 (ru) | Система комплексной обработки информации радионавигационных и автономных средств навигации для определения действительных значений параметров самолетовождения | |
CN109753549B (zh) | 一种大圆航线距离获取方法 | |
CN106595668A (zh) | 一种用于光电吊舱的无源定位算法 | |
CN103335649B (zh) | 一种惯性导航系统极区导航参数解算方法 | |
CN102878872B (zh) | 一种针对导引头失锁情况的制导信息处理方法 | |
CN102506872B (zh) | 一种判定飞行航路偏离的方法 | |
CN102426018A (zh) | 基于混合地形轮廓匹配tercom算法和粒子滤波的地形辅助导航方法 | |
CN112651106B (zh) | 一种等间距大圆航线确定方法及装置 | |
US9704406B1 (en) | Accurate determination of intended ground track with flight management system device and method | |
US20180172841A1 (en) | Positioning apparatus | |
CN105180953A (zh) | 基于气压传感的车辆导航系统的控制方法 | |
CN104215242A (zh) | 一种基于横向游移坐标系的极区惯性导航方法 | |
CN106093992A (zh) | 一种基于cors的亚米级组合定位导航系统及导航方法 | |
CN102565451A (zh) | 通用飞机航行风向、风速的测算方法 | |
CN107525502B (zh) | 一种提高水下航行器惯性地形匹配导航平均精度的方法 | |
CN106017460A (zh) | 一种地形辅助惯导紧组合的水下潜器导航定位方法 | |
CN103162687B (zh) | 基于信息可信度的图像/惯导组合导航方法 | |
Liu et al. | Interacting multiple model UAV navigation algorithm based on a robust cubature Kalman filter | |
CN105180950A (zh) | 基于气压传感的车辆导航系统 | |
Wang et al. | Land vehicle navigation using odometry/INS/vision integrated system | |
CN104634182B (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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20180824 Termination date: 20191222 |