CN116337000A - 基于sins/ldv组合的连续高程测量方法及系统 - Google Patents
基于sins/ldv组合的连续高程测量方法及系统 Download PDFInfo
- Publication number
- CN116337000A CN116337000A CN202310199902.1A CN202310199902A CN116337000A CN 116337000 A CN116337000 A CN 116337000A CN 202310199902 A CN202310199902 A CN 202310199902A CN 116337000 A CN116337000 A CN 116337000A
- Authority
- CN
- China
- Prior art keywords
- laser doppler
- doppler velocimeter
- navigation
- inertial navigation
- velocimeter
- 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.)
- Pending
Links
Images
Classifications
-
- 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
-
- 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
-
- 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
- Y02A—TECHNOLOGIES FOR ADAPTATION TO CLIMATE CHANGE
- Y02A90/00—Technologies having an indirect contribution to adaptation to climate change
- Y02A90/30—Assessment of water resources
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Navigation (AREA)
Abstract
本发明涉及一种基于SINS/LDV组合的连续高程测量方法及系统,属于大地测量领域。所述系统包括捷联惯导系统、激光多普勒测速仪、UPS电源以及导航计算机,其中,捷联惯导系统用于敏感载体的角运动和线运动;捷联惯导系统分别与激光多普勒测速仪和导航计算机连接;激光多普勒测速仪与导航计算机连接,UPS电源分别与捷联惯导系统和激光多普勒测速仪连接;为了提高高程测量精度,以捷联惯导系统的脉冲输出为基准去触发激光多普勒测速仪的输出,预防捷联惯导系统与激光多普勒测速仪内部晶振不一致导致的数据丢失现象。
Description
技术领域
本发明涉及一种基于捷联惯导系统(Strapdown Inertial Navigation System,SINS)/激光多普勒测速仪(Laser Doppler Velocimeter,LDV,通常简称测速仪)组合的连续高程测量方法及系统,属于大地测量领域。
背景技术
高程测量在地质勘探、地形绘制、重力测量等方面具有重要作用。在野外进行作业时,通常需要进行连续高程测量,而目前的高程测量方法如几何水准测量、三角高程测量等方式无法实现连续高程测量,全球卫星导航系统(Global Navigation Satellite System,GNSS)虽然可以实现连续高程测量,但是在丛林、山谷以及高楼密集的环境中GNSS信号较差导致测量精度急剧下降。
为了实现全自主式连续高程测量,可以采用惯导系统与激光多普勒测速仪组合进行测量,惯导系统可以选用旋转惯导系统或捷联惯导系统,两套系统与激光多普勒测速仪组合的高程测量都可以避免环境的影响。其中旋转惯导系统/激光多普勒测速仪组合连续高程测量对惯导系统的陀螺和加速度计精度要求较低,同时存在以下问题:
第一:旋转惯导系统中包含转位机构,增加了惯导系统设计和安装的复杂度,同时也增加了测量系统的不稳定性;
第二:转位机构在安装时存在水平倾角,其补偿过程增加了测量方法的复杂度。
因此,可以采用包含更高精度陀螺和加速度计的捷联惯导系统/激光多普勒测速仪组合的方式进行连续高程测量,一方面降低了系统设计和测量方法的复杂度,另一方面又提高了测量方法的精度。
发明内容
针对当前连续高程测量方法的缺陷,本发明的目的是提出一种基于SINS/LDV组合的连续高程测量方法及系统。
为了实现上述技术目的,本发明的技术方案如下:
一种基于SINS/LDV组合的连续高程测量方法,基于由捷联惯导系统、激光多普勒测速仪、UPS电源以及导航计算机组成的连续高程测量系统,该方法分为以下步骤:
S1:将捷联惯导系统分别与激光多普勒测速仪和导航计算机连接;
将激光多普勒测速仪与导航计算机连接,同时将UPS电源分别与捷联惯导系统和激光多普勒测速仪连接;
S2:在将搭建好的系统安装于载体(例如实验车)时,由于安装误差的存在,测速仪坐标系m系与载体坐标系b系之间不能完全重合,需要对其进行标定;其中影响激光多普勒测速仪速度投影的安装误差有测速仪坐标系m系与载体坐标系b系之间的俯仰安装角误差θ、航向安装角误差ψ以及比例因子K,其标定方法如下:
S2.1:打开激光多普勒测速仪和捷联惯导系统进行数据采样;
S2.2:首先设θ=0、ψ=0以及K=1,起点处地标点A的坐标为(XA,YA,ZA);
S2.3:经过1~2min直线运动后载体行驶到地标点B,其坐标为(XB,YB,ZB),点A到点B位移大小为L1;
激光多普勒测速仪经航迹推算后的位置为点C,其坐标为(XC,YC,ZC),点A到点C位移大小为L2,具体航迹推算方法参见参考文献《One-dimensional reference-beam LDVfor accurate altitude estimation in a land vehicle》(Rong Huang,Qi Wang,Xiaoming Nie,et al,《Applied Optics》,2020.11);
则标定的结果为:
S3:完成系统的安装和激光多普勒测速仪安装误差标定后,接着进入高程测量;
为了得到稳定的高精度实时姿态矩阵必须借助激光多普勒测速仪对惯导系统的天向进行阻尼,通常选择卡尔曼滤波器进行不同传感器之间的信息融合并对系统误差进行估计与反馈,从而抑制惯导系统误差的发散,卡尔曼滤波器的构建步骤参见参考文献《基于二维激光多普勒测速仪的车载组合导航系统》(陈红江,聂晓明,王梦成,《红外与激光工程》,2018.12);
S4:将(4)式展开,某一导航时刻激光多普勒测速仪速度在导航坐标系n系下各个方向上的投影为:
上式中,vE_LDV(l)、vN_LDV(l)、vU_LDV(l)为某一导航时刻激光多普勒测速仪在导航坐标系n系的东、北、天三个方向上的速度投影,为某一导航时刻激光多普勒测速仪在载体坐标系b系的x、y、z轴三个方向上的速度投影;
上式中,T为激光多普勒测速仪的速度更新周期,L(l)、λ(l)、h(l)分别为某一导航时刻航迹推算得到的载体的纬度、经度和高程信息,L(l-1)、λ(l-1)、h(l-1)分别为上一导航时刻航迹推算得到的载体的纬度、经度和高程信息,其中起始点位置L0、λ0、h0由地标点给出,RE、RN分别为载体所在位置的卯酉圈半径和子午圈半径;
最后,经过(6)式中第三式,可以连续测得载体行驶过程中的高程信息。
本发明还提供一种基于上述方法的连续高程测量系统,包括捷联惯导系统(Strapdown Inertial Navigation System,SINS)、激光多普勒测速仪、UPS电源以及导航计算机,其中,捷联惯导系统用于敏感载体的角运动和线运动;捷联惯导系统分别与激光多普勒测速仪和导航计算机连接;激光多普勒测速仪与导航计算机连接,UPS电源分别与捷联惯导系统和激光多普勒测速仪连接;为了提高高程测量精度,以捷联惯导系统的脉冲输出为基准去触发激光多普勒测速仪的输出,预防捷联惯导系统与激光多普勒测速仪内部晶振不一致导致的数据丢失现象。
为了降低系统设计复杂度,采用基于固态探测体的激光多普勒测速仪,不需要人为掺杂示踪粒子,而是利用探测体表面的自然颗粒。
与现有技术相比,本发明的优点在于:
1.本发明对高程测量方法及系统进行了简化,提高了高程测量效率;
2.本发明的高程测量方法完全不依赖GNSS信号,属于全自主式连续高程测量,在密林、山谷以及极端天气等环境中仍可保持较高的连续高程测量精度,极大地提高了连续高程测量的环境适应能力;
3.为了防止晶振不一致导致捷联惯导系统和激光多普勒测速仪的数据采集频率不完全一致,以捷联惯导系统的脉冲输出去触发激光多普勒测速仪的输出,进一步提高了连续高程测量的精度。
附图说明
为了更加清晰地描述本发明的技术方案,下面结合附图对其作进一步阐述。
图1本发明系统的组成原理示意图
图2本发明系统的安装示意图
图中数字说明:1-激光多普勒测速仪;2-捷联惯导系统;3-全球定位系统;4-导航计算机;5-UPS电源;
图3车载连续高程测量实验路径示意图
图4车载连续高程测量实验中的高程变化示意图
图5车载连续高程测量实验中的高程测量误差变化示意图
具体实施方式
为了使本发明的技术方案及优点更加清楚明白,现结合附图及实施例,对本发明进一步详细说明。应当理解,此处所描述的具体实施例仅用于解释本发明,并不用于限定本发明。
本发明的可行性可以通过车载实验进行验证:
实验采用的捷联惯导系统的陀螺零偏稳定性优于0.0015°/h,加速度计零偏稳定性优于20μg,定位精度优于0.5nm/1h;激光多普勒测速仪测速精度优于0.05%,输出频率为100Hz,UPS电源额定功率为5400W,输出电压为110~220V,导航计算机为常规的笔记本电脑,系统的组成原理如图1所示;为了方便比较,采用差分全球点位系统(GlobalPositioning System,GPS)提供位置参考基准(输出频率1Hz,单点状态下高程定位精度3m,差分状态下高程定位精度4cm)。
捷联惯导系统安装在试验车车体内,激光多普勒测速仪安装于车底,GPS天线位于车顶,图2所示系统的安装示意图。
实验地点选择湖南省长沙市万家丽高架,实验路径示意图如图3所示,万家丽高架单程约15km,实验共一个来回,总里程30km,实验过程中的真实高程变化情况如图4所示。
在进入测量之前,采用本发明的连续高程测量方法中的步骤S2完成测速仪安装误差的标定,其中,俯仰安装角误差θ=-6.2824°、航向安装角误差ψ=0.2613°、比例因子K=1.1783。
最后,根据本发明的连续高程测量方法中的步骤S3和S4完成连续高程测量,其测量过程中误差变化曲线如图5所示,其中最大的高程测量误差为0.54m,最小的高程测量误差为-0.58m。
根据车载连续高程测量的实验结果可知,其测量结果可以满足基本的高程测量需求。
综上所述,本发明在于提出一种基于SINS/LDV的连续高程测量系统及方法,并针对其中的关键技术进行了权利要求。该发明属于全自主式车载连续高程测量,具有精度高、结构简单、环境适应能力强等特点。
以上为本发明的连续高程测量系统及方法,本发明的保护范围并不局限于上述实施例,凡是属于本发明思路下的技术方案均应数据本发明的保护范围。应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理前提下的若干改进和润饰,这些改进和润饰也应该视为本发明的保护范围。
Claims (4)
1.一种基于SINS/LDV组合的连续高程测量方法,基于由捷联惯导系统、激光多普勒测速仪、UPS电源以及导航计算机组成的连续高程测量系统,其特征在于,该方法分为以下步骤:
S1:将捷联惯导系统分别与激光多普勒测速仪和导航计算机连接;
将激光多普勒测速仪与导航计算机连接,同时将UPS电源分别与捷联惯导系统和激光多普勒测速仪连接;
S2:在将搭建好的系统安装于载体时,由于安装误差的存在,测速仪坐标系m系与载体坐标系b系之间不能完全重合,需要对其进行标定;其中影响激光多普勒测速仪速度投影的安装误差有测速仪坐标系m系与载体坐标系b系之间的俯仰安装角误差θ、航向安装角误差ψ以及比例因子K,其标定方法如下:
S2.1:打开激光多普勒测速仪和捷联惯导系统进行数据采样;
S2.2:首先设θ=0、ψ=0以及K=1,起点处地标点A的坐标为(XA,YA,ZA);
S2.3:经过1~2min直线运动后载体行驶到地标点B,其坐标为(XB,YB,ZB),点A到点B位移大小为L1;
激光多普勒测速仪经航迹推算后的位置为点C,其坐标为(XC,YC,ZC),点A到点C位移大小为L2;
则标定的结果为:
S3:完成系统的安装和激光多普勒测速仪安装误差标定后,接着进入高程测量;
S4:将(4)式展开,某一导航时刻激光多普勒测速仪速度在导航坐标系n系下各个方向上的投影为:
上式中,vE_LDV(l)、vN_LDV(l)、vU_LDV(l)为某一导航时刻激光多普勒测速仪在导航坐标系n系的东、北、天三个方向上的速度投影,为某一导航时刻激光多普勒测速仪在载体坐标系b系的x、y、z轴三个方向上的速度投影;
h(l)=h(l-1)+TvU_LDV(l)
上式中,T为激光多普勒测速仪的速度更新周期,L(l)、λ(l)、h(l)分别为某一导航时刻航迹推算得到的载体的纬度、经度和高程信息,L(l-1)、λ(l-1)、h(l-1)分别为上一导航时刻航迹推算得到的载体的纬度、经度和高程信息,其中起始点位置L0、λ0、h0由地标点给出,RE、RN分别为载体所在位置的卯酉圈半径和子午圈半径;
最后,经过(6)式中第三式,可以连续测得载体行驶过程中的高程信息。
3.一种基于权利要求1或2所述方法的连续高程测量系统,其特征在于:包括捷联惯导系统、激光多普勒测速仪、UPS电源以及导航计算机,其中,捷联惯导系统用于敏感载体的角运动和线运动;捷联惯导系统分别与激光多普勒测速仪和导航计算机连接;激光多普勒测速仪与导航计算机连接,UPS电源分别与捷联惯导系统和激光多普勒测速仪连接;为了提高高程测量精度,以捷联惯导系统的脉冲输出为基准去触发激光多普勒测速仪的输出,预防捷联惯导系统与激光多普勒测速仪内部晶振不一致导致的数据丢失现象。
4.一种基于权利要求3所述的连续高程测量系统,其特征在于:为了降低系统设计复杂度,采用基于固态探测体的激光多普勒测速仪,不需要人为掺杂示踪粒子,而是利用探测体表面的自然颗粒。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310199902.1A CN116337000A (zh) | 2023-03-06 | 2023-03-06 | 基于sins/ldv组合的连续高程测量方法及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310199902.1A CN116337000A (zh) | 2023-03-06 | 2023-03-06 | 基于sins/ldv组合的连续高程测量方法及系统 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN116337000A true CN116337000A (zh) | 2023-06-27 |
Family
ID=86892235
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202310199902.1A Pending CN116337000A (zh) | 2023-03-06 | 2023-03-06 | 基于sins/ldv组合的连续高程测量方法及系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN116337000A (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117249826A (zh) * | 2023-11-14 | 2023-12-19 | 中国人民解放军国防科技大学 | 基于二维ldv和惯导系统的容错组合导航方法及装置 |
-
2023
- 2023-03-06 CN CN202310199902.1A patent/CN116337000A/zh active Pending
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117249826A (zh) * | 2023-11-14 | 2023-12-19 | 中国人民解放军国防科技大学 | 基于二维ldv和惯导系统的容错组合导航方法及装置 |
CN117249826B (zh) * | 2023-11-14 | 2024-01-30 | 中国人民解放军国防科技大学 | 基于二维ldv和惯导系统的容错组合导航方法及装置 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US6493631B1 (en) | Geophysical inertial navigation system | |
CN1322311C (zh) | 车载快速定位定向系统 | |
CN104697520B (zh) | 一体化无陀螺捷联惯导系统与gps系统组合导航方法 | |
CN105091907B (zh) | Sins/dvl组合中dvl方位安装误差估计方法 | |
CN101858748A (zh) | 高空长航无人机的多传感器容错自主导航方法 | |
CN111829512B (zh) | 一种基于多传感器数据融合的auv导航定位方法及系统 | |
CN111426320B (zh) | 一种基于图像匹配/惯导/里程计的车辆自主导航方法 | |
CN112378399B (zh) | 基于捷联惯导和数字全站仪的煤矿巷道掘进机器人精确定位定向方法 | |
CN111637888B (zh) | 基于惯导和激光雷达单点测距的掘进机定位方法及系统 | |
CN109506660B (zh) | 一种用于仿生导航的姿态最优化解算方法 | |
CN102393201A (zh) | 航空遥感用位置和姿态测量系统(pos)动态杆臂补偿方法 | |
CN103630136A (zh) | 冗余传感器配置下基于三级滤波的导航参数最优融合方法 | |
CN105928515A (zh) | 一种无人机导航系统 | |
CN116337000A (zh) | 基于sins/ldv组合的连续高程测量方法及系统 | |
CN103712621A (zh) | 偏振光及红外传感器辅助惯导系统定姿方法 | |
CN111207773B (zh) | 一种用于仿生偏振光导航的姿态无约束优化求解方法 | |
Xiang et al. | A SINS/GNSS/2D-LDV integrated navigation scheme for unmanned ground vehicles | |
CN116559966B (zh) | 基于sins/ldv组合的重力测量方法及系统 | |
CN105928519B (zh) | 基于ins惯性导航与gps导航以及磁力计的导航算法 | |
CN105953797A (zh) | 利用单轴陀螺仪、倾角仪和里程计的组合导航装置及方法 | |
CN117804443A (zh) | 一种北斗卫星多模融合定位监测方法及系统 | |
CN115202383B (zh) | 一种无人机多维航迹表达及生成方法 | |
CN115079287B (zh) | 陀螺组件姿态观测的捷联式车载动态重力矢量测量方法 | |
CN116839591A (zh) | 一种轨迹跟踪定位滤波系统及救援无人机的融合导航方法 | |
CN116147577B (zh) | 基于单轴rins/ldv组合的连续高程测量方法及系统 |
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 |