CN113074722B - 基于视觉辅助技术对地形参考导航精度提升定位修正方法 - Google Patents
基于视觉辅助技术对地形参考导航精度提升定位修正方法 Download PDFInfo
- Publication number
- CN113074722B CN113074722B CN202010006227.2A CN202010006227A CN113074722B CN 113074722 B CN113074722 B CN 113074722B CN 202010006227 A CN202010006227 A CN 202010006227A CN 113074722 B CN113074722 B CN 113074722B
- Authority
- CN
- China
- Prior art keywords
- terrain
- landmark
- navigation
- information
- navigation system
- 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.)
- Active
Links
- 238000005516 engineering process Methods 0.000 title claims abstract description 20
- 238000000034 method Methods 0.000 title claims abstract description 15
- 230000000007 visual effect Effects 0.000 claims description 18
- 238000005259 measurement Methods 0.000 claims description 11
- 239000011159 matrix material Substances 0.000 claims description 9
- 238000004364 calculation method Methods 0.000 claims description 6
- 238000004458 analytical method Methods 0.000 claims description 4
- 230000003068 static effect Effects 0.000 claims description 4
- 238000001914 filtration Methods 0.000 claims description 3
- 238000012876 topography Methods 0.000 description 3
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000007405 data analysis Methods 0.000 description 1
- 230000002708 enhancing effect Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000002265 prevention Effects 0.000 description 1
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/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
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C5/00—Measuring height; Measuring distances transverse to line of sight; Levelling between separated points; Surveyors' levels
- G01C5/005—Measuring height; Measuring distances transverse to line of sight; Levelling between separated points; Surveyors' levels altimeters for aircraft
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
- Navigation (AREA)
Abstract
本发明公开了基于视觉辅助技术对地形参考导航精度提升定位修正方法,在航空器飞行过程中,用数字地图提供参考信息,通过视觉辅助对其参考信息进行精度提升,共同辅助校正惯性导航系统,达到提高导航精度,増强系统可靠性等目标的一种精确导航的技术。
Description
技术领域
本发明涉及航空电子系统技术与数据分析技术,尤其是航空器中广泛应用的导航定位技术中涉及的辅助导航定位技术,此类系统包括但不限于惯性导航系统、视觉辅助导航技术及地形参考导航定位技术等具体产品。
技术背景
视觉辅助导航技术(Vision Navigation System,简称VNS)是一种用于不良视觉导航环境下的惯性导航定位和视觉导航定位的组合导航方法。通过将摄像机的测量图像与存储的图像或地图的存储信息或地标的焦平面测量信息或 利用摄像机所拍的连续图像之间距离来确定飞机的运动的导航定位技术。
地形参考导航定位技术(Terrain Aided Navigation,简称TAN)是全球导航系统(Global Positioning System,简称GPS)是用数字地图提供参考信息,来辅助校正惯性导航系统,达到提高导航精度,増强系统可靠性等目标的一种精确导航的技术,俗称地形匹配。
地形参考导航定位技术技术在地形特征明显的区域,具有较高的导航精度,对战斗机近空支援、低空强击、突防、截击等战术飞行也十分有用。
通过组合视觉辅助导航技术和地形参考导航定位技术两种导航定位系统,并辅以卡尔曼滤波误差估计,实现对惯性导航系统(Inertial Navigation System,简称INS)的导航定位修正,为航空器提供高精度的导航定位。
发明内容
本发明公开了一种基于视觉辅助技术对地形参考导航精度提升的定位修正方法,在航空器飞行过程中,用数字地图提供参考信息,通过视觉辅助对其参考信息进行精度提升,共同辅助校正惯性导航系统,达到提高导航精度,増强系统可靠性等目标的一种精确导航的技术。
本发明提供了一种基于视觉辅助技术对地形参考导航精度提升的定位修正方法,包括以下步骤:一种基于视觉辅助技术对地形参考导航精度提升的定位修正方法,其特征在于,包括以下步骤:
步骤A,视觉传感器获取图像信息vision;
步骤B,视觉导航系统生成焦平面上的测量值与地标坐标值之间的关系uk,vk,,其中uk=f(yc k/xc k), vk=f(yc k/zc k),x,y,z分别表示焦平面上的投影坐标,相机的焦平面上的界标测量获得导航输出的导航等式,pn k- pn u=rkcn bcb cpc k,下标k表示地标的索引,而pn k是地标的已知位置矢量,b,c和n分别表示航空器框架,相机框架和导航框架。pn u是导航框架中车辆的三维位置矢量,rk 是焦平面上的投影地标与相机帧中的实际地标的距离比,cn b和cb c是从主体框架到导航框架的方向余弦矩阵和从相机框架到主体框架的方向余弦矩阵,cb c是一个常数矩阵;
步骤C,地形测量系统将获取的实测地形高度hs发送给数字地图模块;
步骤D,结合地形测量系统发送的获取的实测地形高度hs,数字地图模块生成地形剖面;
步骤E,视觉导航系统发送焦平面上的测量值与地标坐标值之间的关系uk,vk给地形匹配系统;
步骤F,数字地图模块发送生成的地形剖面给地形匹配系统;
步骤G,地形匹配系统对接收到的焦平面上的测量值与地标坐标值之间的关系uk,vk和地形剖面进行分析,输出位置修正信息;
步骤H,地形匹配系统将步骤F生成的位置修正信息发送给惯性导航系统;
步骤I,雷达高度表将测得的实时雷达高度数据h发送给计算机;
步骤J,大气数据计算机将测得的实时大气飞行数据信息(包括空速v1,真空速v2,马赫数Ma、大气静温c、迎角α等)发送给计算机;
步骤K,惯性导航系统对地形匹配系统发来的位置修正信息进行分析计算处理,得到位置p,速度v,姿态s信息;
步骤L,惯性导航系统将得到的位置p,速度v,姿态s信息发送给计算机;
步骤M,计算机对由惯性导航系统得到的位置p,速度v,姿态s信息和由雷达高度表测得的实时雷达高度数据h以及大气数据计算机测得的实时大气飞行数据信息(包括空速v1,真空速v2,马赫数Ma、大气静温c、迎角α等)三者进行综合计算分析;
步骤N,计算机将分析结果分别发送给惯性导航系统和卡尔曼滤波计算模块,用于更新航空器实时位置信息;
步骤O,卡尔曼滤波计算模块将估计误差分别返回给视觉导航系统和惯性导航系统;
步骤P,重复步骤A至步骤O,对航空器的位置进行持续实时修正。
与现有技术相比,本发明的有益效果在于:该方法与惯性导航系统INS结合,在导航定位设备中实现,为航空器提供精确导航定位、紧急威胁回避、智能贴地告警、精确武器投放等诸多功能,其导航定位结果用于修正惯性导航系统INS误差,以实现各种航行器对对高精度导航定位的需要。
附图说明
以下将结合附图对本发明作进一步说明。
图1图示了根据本发明的实施例的典型流程。
具体实施方式
以下通过较佳实例对本发明的技术方案进行说明,但下述实例并不能限制本发明的保护范围。
本发明所提供的基于视觉辅助技术对地形参考导航精度提升的定位修正方法能够以软件的形式内置于航空器上的航空电子装置,如导航定位系统、飞行控制系统、飞行管理系统等航电设备。此外,本发明提供的高精度的航空器导航定位方法不仅可用于战斗机,也可应用于攻击机、用于作战的无人机等。
附图1为根据本发明的一个实施例形成的单周期典型流程图。在每周期内,方法按照附图1所示顺序执行。
参照图1,在方块101处,视觉传感器获取图像信息vision,并将图像信息发送给视觉导航系统;
参照图1,在方块102处,视觉导航系统将生成焦平面上的测量值与地标坐标值之间的关系uk,vk发送给惯性导航系统INS,其中uk=f(yck/xck), vk=f(yck/zck),x,y,z分别表示焦平面上的投影坐标, 从相机的焦平面上的界标测量获得导航输出的导航等式,
pnk- pnu=rkcnbcbcpck, 下标k表示地标的索引,而pnk是地标的已知位置矢量。b,c和n分别表示航空器框架,相机框架和导航框架。pnu是导航框架中车辆的三维位置矢量。rk 是焦平面上的投影地标与相机帧中的实际地标的距离比。。cnb和cbc是从主体框架到导航框架的方向余弦矩阵和从相机框架到主体框架的方向余弦矩阵。这里,cbc是一个常数矩阵,因为相机固定在机体上。
参照图1,在方块103处,地形测量系统将获取的实测地形高度hs发送给数字地图模块;
参照图1,在方块104处,结合地形测量系统发送的获取的实测地形高度hs,数字地图模块生成地形剖面,发送给地形匹配系统。
参照图1,在方块105处,地形匹配系统对接收到的焦平面上的测量值与地标坐标值之间的关系uk,vk和地形剖面进行分析,其中uk=f(yck/xck), vk=f(yck/zck),x,y,z分别表示焦平面上的投影坐标;输出位置修正信息,发送给惯性导航系统INS。
参照图1,在方块106处,雷达高度表将测得的实时雷达高度数据h发送给计算机。
参照图1,在方块107处,大气数据计算机将测得的实时大气飞行数据信息(包括空速v1,真空速v2,马赫数Ma、大气静温c、迎角α等)发送给计算机。
参照图1,在方块108处,惯性导航系统对地形匹配系统发来的位置修正信息进行分析计算处理,得到位置p,速度v,姿态s信息,发送给计算机。
参照图1,在方块109处,卡尔曼滤波计算模块将估计误差分别返回给视觉导航系统和惯性导航系统。
参照图1,在方块110处,对由惯性导航系统得到的位置p,速度v,姿态s信息和由雷达高度表测得的实时雷达高度数据h以及大气数据计算机测得的实时大气飞行数据信息(包括空速v1,真空速v2,马赫数Ma、大气静温c、迎角α等)三者进行综合计算分析,将分析结果分别发送给惯性导航系统和卡尔曼滤波计算模块,用于更新航空器实时位置信息。
参照图1,在方块105处,地形匹配系统根据视觉导航系统提供的焦平面上的测量值与地标坐标值之间的关系uk,vk以及接收的地形剖面进行分析,修正位置信息,提高精度。
值得说明的是,上述描述是基于发明的具体实施例而进行的,尽管参照较佳实施例在本发明进行了详细阐述,但本领域的技术人员应当理解,可以对本发明的技术方案进行修改或者等同替换,而不脱离本发明技术方案的精神和范围。
Claims (1)
1.基于视觉辅助技术对地形参考导航精度提升定位修正方法,其特征在于,包括以下步骤:
步骤A,视觉传感器获取图像信息vision;
步骤B,视觉导航系统生成焦平面上的测量值与地标坐标值之间的关系uk,vk,其中uk=f(yc k/xc k), vk=f(yc k/zc k),x,y,z分别表示焦平面上的投影坐标,相机的焦平面上的界标测量获得导航输出的导航等式,pn k- pn u=rkcn bcb cpc k,下标k表示地标的索引,而pn k是地标的已知位置矢量,b,c和n分别表示航空器框架,相机框架和导航框架;pn u是导航框架中车辆的三维位置矢量,rk 是焦平面上的投影地标与相机帧中的实际地标的距离比,cn b和cb c是从主体框架到导航框架的方向余弦矩阵和从相机框架到主体框架的方向余弦矩阵,cb c是一个常数矩阵;
步骤C,地形测量系统将获取的实测地形高度hs发送给数字地图模块;
步骤D,结合地形测量系统发送的获取的实测地形高度hs,数字地图模块生成地形剖面;
步骤E,视觉导航系统发送焦平面上的测量值与地标坐标值之间的关系uk,vk给地形匹配系统;
步骤F,数字地图模块发送生成的地形剖面给地形匹配系统;
步骤G,地形匹配系统对接收到的焦平面上的测量值与地标坐标值之间的关系uk,vk和地形剖面进行分析,输出位置修正信息;
步骤H,地形匹配系统将步骤G生成的位置修正信息发送给惯性导航系统;
步骤I,雷达高度表将测得的实时雷达高度数据h发送给计算机;
步骤J,大气数据计算机将测得的实时大气飞行数据信息发送给计算机,实时大气飞行数据信息包括空速v1、真空速v2、马赫数Ma、大气静温c、迎角α;
步骤K,惯性导航系统对地形匹配系统发来的位置修正信息进行分析计算处理,得到位置p,速度v,姿态s信息;
步骤L,惯性导航系统将得到的位置p,速度v,姿态s信息发送给计算机;
步骤M,计算机对由惯性导航系统得到的位置p,速度v,姿态s信息和由雷达高度表测得的实时雷达高度数据h以及大气数据计算机测得的实时大气飞行数据信息三者进行综合计算分析;
步骤N,计算机将分析结果分别发送给惯性导航系统和卡尔曼滤波计算模块,用于更新航空器实时位置信息;
步骤O,卡尔曼滤波计算模块将估计误差分别返回给视觉导航系统和惯性导航系统;
步骤P,重复步骤A至步骤O,对航空器的位置进行持续实时修正。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010006227.2A CN113074722B (zh) | 2020-01-03 | 2020-01-03 | 基于视觉辅助技术对地形参考导航精度提升定位修正方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010006227.2A CN113074722B (zh) | 2020-01-03 | 2020-01-03 | 基于视觉辅助技术对地形参考导航精度提升定位修正方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113074722A CN113074722A (zh) | 2021-07-06 |
CN113074722B true CN113074722B (zh) | 2024-06-11 |
Family
ID=76608646
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010006227.2A Active CN113074722B (zh) | 2020-01-03 | 2020-01-03 | 基于视觉辅助技术对地形参考导航精度提升定位修正方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113074722B (zh) |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102506868A (zh) * | 2011-11-21 | 2012-06-20 | 清华大学 | 基于联邦滤波的sins/smans/trns组合导航方法及系统 |
EP2515078A2 (en) * | 2011-04-19 | 2012-10-24 | Honeywell International Inc. | Systems and methods for navigation in a GPS-denied environment |
CN107690840B (zh) * | 2009-06-24 | 2013-07-31 | 中国科学院自动化研究所 | 无人机视觉辅助导航方法及系统 |
CN107314768A (zh) * | 2017-07-06 | 2017-11-03 | 上海海洋大学 | 水下地形匹配辅助惯性导航定位方法及其定位系统 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20050232512A1 (en) * | 2004-04-20 | 2005-10-20 | Max-Viz, Inc. | Neural net based processor for synthetic vision fusion |
-
2020
- 2020-01-03 CN CN202010006227.2A patent/CN113074722B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107690840B (zh) * | 2009-06-24 | 2013-07-31 | 中国科学院自动化研究所 | 无人机视觉辅助导航方法及系统 |
EP2515078A2 (en) * | 2011-04-19 | 2012-10-24 | Honeywell International Inc. | Systems and methods for navigation in a GPS-denied environment |
CN102506868A (zh) * | 2011-11-21 | 2012-06-20 | 清华大学 | 基于联邦滤波的sins/smans/trns组合导航方法及系统 |
CN107314768A (zh) * | 2017-07-06 | 2017-11-03 | 上海海洋大学 | 水下地形匹配辅助惯性导航定位方法及其定位系统 |
Non-Patent Citations (2)
Title |
---|
一种直升机合成视景辅助导航技术;齐小谦;周兴;王炳翮;杨乐;;无线电工程;20190529(第06期);全文 * |
地形匹配辅助导航中匹配区域的选择;郑彤;蔡龙飞;王志刚;边少锋;;中国惯性技术学报;20090415(第02期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN113074722A (zh) | 2021-07-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107727079B (zh) | 一种微小型无人机全捷联下视相机的目标定位方法 | |
US7463340B2 (en) | Ladar-based motion estimation for navigation | |
US7408629B2 (en) | Passive measurement of terrain parameters | |
US9477230B2 (en) | Method for the acquisition and processing of geographical information of a path | |
CN111426320B (zh) | 一种基于图像匹配/惯导/里程计的车辆自主导航方法 | |
CN110873570A (zh) | 用于位置信息的定源、生成并且更新表示位置的地图的方法和装置 | |
JPH06316299A (ja) | 航空機用搭載航法装置 | |
CN109143303B (zh) | 飞行定位方法、装置及固定翼无人机 | |
CN112346104A (zh) | 一种无人机信息融合定位方法 | |
KR101764222B1 (ko) | 고정밀 측위 시스템 및 방법 | |
Andert et al. | Optical-aided aircraft navigation using decoupled visual SLAM with range sensor augmentation | |
US20020188386A1 (en) | GPS based terrain referenced navigation system | |
CN117387604A (zh) | 基于4d毫米波雷达和imu融合的定位与建图方法及系统 | |
CN113074722B (zh) | 基于视觉辅助技术对地形参考导航精度提升定位修正方法 | |
EP2502025A1 (en) | A method estimating absolute orientation of a vehicle | |
de Haag et al. | Application of laser range scanner based terrain referenced navigation systems for aircraft guidance | |
EP4370989A1 (en) | Devices, systems and methods for navigating a mobile platform | |
CN112985456B (zh) | 一种融合机载测高数据及地形数据的导航定位修正方法 | |
Runnalls et al. | Terrain-referenced navigation using the IGMAP data fusion algorithm | |
de Haag et al. | Flight test and simulation results of an integrated dual airborne laser scanner and inertial navigator for UAV applications | |
CN112985382B (zh) | 一种高精度的战斗机地形参考导航定位方法 | |
CN110082805A (zh) | 一种三维定位装置和方法 | |
RU2232102C1 (ru) | Распределенный информационно-управляющий комплекс группы многофункциональных летательных аппаратов | |
RU2232376C1 (ru) | Информационно-управляющий комплекс многофункциональных летательных аппаратов | |
CN117346768B (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 |