CN116147577A - 基于单轴rins/ldv组合的连续高程测量方法及*** - Google Patents
基于单轴rins/ldv组合的连续高程测量方法及*** Download PDFInfo
- Publication number
- CN116147577A CN116147577A CN202310199906.XA CN202310199906A CN116147577A CN 116147577 A CN116147577 A CN 116147577A CN 202310199906 A CN202310199906 A CN 202310199906A CN 116147577 A CN116147577 A CN 116147577A
- Authority
- CN
- China
- Prior art keywords
- navigation
- laser doppler
- doppler velocimeter
- carrier
- inertial
- 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
- 238000000691 measurement method Methods 0.000 title claims abstract description 15
- 238000005259 measurement Methods 0.000 claims abstract description 109
- 230000007246 mechanism Effects 0.000 claims abstract description 24
- 239000011159 matrix material Substances 0.000 claims description 36
- 238000009434 installation Methods 0.000 claims description 23
- 238000000034 method Methods 0.000 claims description 18
- 230000008569 process Effects 0.000 claims description 5
- 230000003068 static effect Effects 0.000 claims description 5
- 238000006073 displacement reaction Methods 0.000 claims description 4
- 239000002245 particle Substances 0.000 claims description 4
- 239000013078 crystal Substances 0.000 claims description 3
- 238000013016 damping Methods 0.000 claims description 3
- 238000013461 design Methods 0.000 claims description 2
- 230000004927 fusion Effects 0.000 claims description 2
- 238000005070 sampling Methods 0.000 claims description 2
- 238000010586 diagram Methods 0.000 description 7
- 238000002474 experimental method Methods 0.000 description 6
- 230000008859 change Effects 0.000 description 4
- 238000005299 abrasion Methods 0.000 description 1
- 230000006978 adaptation Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000003672 processing method Methods 0.000 description 1
- 230000009897 systematic effect Effects 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
- 238000012876 topography Methods 0.000 description 1
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
本发明涉及一种基于RINS/LDV组合的连续高程测量***及方法，属于大地测量领域；所述***包括惯性测量单元、转位机构、激光多普勒测速仪、UPS电源以及导航计算机，其中，惯性测量单元安装在转位机构上，组成单轴旋转惯导***，用于敏感载体的角运动和线运动；惯性测量单元分别与激光多普勒测速仪和导航计算机连接；激光多普勒测速仪与导航计算机连接，UPS电源分别与单轴旋转惯导***和激光多普勒测速仪连接；本发明完全不依赖GNSS信号，属于全自主式连续高程测量，在密林、山谷以及极端天气等环境中仍可保持较高的连续高程测量精度，极大地提高了连续高程测量的环境适应能力。
Description
技术领域
本发明涉及一种基于单轴旋转惯导***(Rotational Inertial NavigationSystem,RINS)/激光多普勒测速仪(Laser Doppler Velocimeter,LDV，通常简称为测速仪)组合的连续高程测量***及方法，属于大地测量领域。
背景技术
高程测量在地质勘探、地形绘制、重力测量等方面具有重要作用。目前常见的几种高程测量方法有全球卫星导航***(Global Navigation Satellite System,GNSS)高程测量、几何水准测量与三角高程测量等；GNSS高程测量方法可以实现连续高程测量，其精度与GNSS定位精度相当，但在丛林、山谷遮挡、高楼密集等GNSS接收机信号受影响的地区的精度较差；几何水准测量的精度比较高，单点高程测量精度可以达到厘米量级，但受距离和地形起伏的限制，外业工作量大，施测速度慢，无法实现连续高程测量；三角高程测量不受地形的限制，单点高程测量精度也可以达到厘米量级，但是每次测量都需要量取仪器高、棱镜高，操作繁琐且同样无法实现连续高程测量。
惯性导航***(Inertial Navigation System，INS，通常简称为惯导***)是利用惯性敏感元件测量载体相对惯性空间的角运动和线运动，以获得载体的姿态、速度和位置等信息的自主导航***。惯导***在纯惯性状态下天向通道处于发散状态，无法单独实现高程测量，通常只能依靠卫星导航、里程计、气压计等提供高程信息。在野外进行作业时，GNSS信号容易受到测量环境遮挡、里程计容易发生轮胎磨损和打滑以及气压计容易受到环境气流影响等限制导致诸多传感器不能为惯导***持续提供高程信息，因此有必要研究一种新的不受环境影响的连续高程测量方法，满足实际的工程应用需求。
发明内容
针对当前连续高程测量方法的缺陷，本发明的目的是提出一种基于单轴RINS/LDV组合的连续高程测量***及数据处理方法。
为了实现上述技术目的，本发明的技术方案如下：
一种基于单轴RINS/LDV组合的连续高程测量方法，基于由惯性测量单元(Inertial Measurement Unit,IMU)、转位机构、激光多普勒测速仪、UPS电源以及导航计算机组成的连续高程测量***，该方法分为以下步骤：
S1：将惯性测量单元安装在转位机构上，组成单轴旋转惯导***(RINS)，RINS可以敏感载体(例如实验车)的角运动和线运动；
将单轴旋转惯导***分别与激光多普勒测速仪和导航计算机连接；
将激光多普勒测速仪与导航计算机连接，同时将UPS电源分别与单轴旋转惯导***和激光多普勒测速仪连接；
惯性测量单元安装到转位机构上时，惯性测量单元坐标系s系与载体坐标系b系无法完全重合，在垂直方向上存在一个与转位机构的转动方式有关的规律性大转角，在水平方向上存在由安装误差引起固定的小角度水平倾角，其可以分解为两个欧拉角α、β，这也是限制单轴旋转惯导***导航精度的主要因素，其中垂直方向上的大转角是已知的，因此在进行高程测量前只需要对水平倾角进行补偿。
S2：将搭建好的***安装于载体后，首先进行静态下惯性测量单元的水平倾角标定，具体标定步骤如下：
S2.1：水平倾角标定时不需要使用激光多普勒测速仪，因此仅打开导航计算机、UPS电源以及单轴旋转惯导***进行数据采集，同时载体处于静止状态；
S2.2：通过导航计算机控制转位机构转动180°；
S2.3：利用导航计算机对惯性测量单元的输出进行姿态解算，得到惯性测量单元在初始位置和180°位置时惯性测量单元坐标系s系和导航坐标系n系之间的姿态矩阵
和/>
由于η2＝η1+180°，所以：
上式中，l1、l2分别为水平倾角标定期间惯性测量单元在初始位置和180°位置的时刻，η1和η2分别为惯性测量单元坐标系s系和载体坐标系b系在初始位置和180°位置时垂直方向的大转角，
分别为载体静止期间惯性测量单元在初始位置和180°位置时载体坐标系b系和导航坐标系n系之间的姿态矩阵，由于水平倾角标定期间载体一直静止，所以/>
与/>
相同，/>
分别为惯性测量单元在初始位置和180°位置时b系相对于s系的姿态矩阵；
S2.4：将(1)式和(2)式相加，并令
表示3×3矩阵/>
的矩阵元素,得到：
由于导航计算机进行惯导***的姿态解算后可以得到3×3姿态矩阵
和/>
则两姿态矩阵相加后的矩阵元素Cij(i＝1,2,3；j＝1,2,3)是已知的。
S2.5：由(3)式得到水平倾角α和β：
根据水平倾角α、β以及任意时刻s系和b系在垂直方向上的大转角η，得到任意时刻载体坐标系和惯性测量单元坐标系之间的姿态矩阵
S3：由于激光多普勒测速仪与载体之间也存在安装误差，也需要对其进行标定，影响激光多普勒测速仪速度投影的安装误差有测速仪坐标系m系与载体坐标系b系之间的俯仰安装角误差θ、航向安装角误差ψ以及比例因子K，其标定方法如下：
S3.1：打开激光多普勒测速仪，并重启单轴旋转惯导***重新进行采样；
S3.2：首先设θ＝0、ψ＝0以及K＝1，起点处地标点A的坐标为(XA，YA，ZA)；
S3.3：经过1～2min直线运动后载体行驶到地标点B，其坐标为(XB，YB，ZB)，A到B位移大小为L1；
激光多普勒测速仪经航迹推算后的位置为C，其坐标为(XC，YC，ZC)，A到C位移大小为L2，具体航迹推算方法参见参考文献《One-dimensional reference-beam LDV foraccurate altitude estimation in a land vehicle》(Rong Huang,Qi Wang,XiaomingNie,et al,《Applied Optics》,2020.11)；
则标定的结果为：
S3.4：通过标定后的俯仰安装角误差θ、航向安装角误差ψ计算得到测速仪坐标系m系和载体坐标系b系之间的安装误差矩阵
通过计算的测速仪坐标系m系和载体坐标系b系之间的安装误差矩阵
以及比例因子K，得到某一导航时刻激光多普勒测速仪速度在b系下的投影：
式中，l3为打开测速仪和重启惯导***后数据采样的时刻，
为某一导航时刻激光多普勒测速仪测量的速度在测速仪坐标系m系下投影，由激光多普勒测速仪提供。
S4：完成测速仪的安装误差标定后直接进入高程测量；
进入高程测量后，导航计算机对测量过程中惯性测量单元的输出进行姿态解算，得到实时的3×3姿态矩阵
根据S2标定完成的姿态矩阵/>
计算得到载体坐标系与导航坐标系之间的实时姿态矩阵/>
通过实时姿态矩阵
进一步得到某一导航时刻测速仪速度在导航坐标系n系下的投影/>
惯导***由于天向无阻尼会导致***误差迅速发散，实时姿态矩阵
的误差也会迅速增大，因此测速仪速度/>
的误差也会增大；
为了得到稳定的高精度实时姿态矩阵
必须借助激光多普勒测速仪对惯导***的天向进行阻尼，通常选择卡尔曼滤波器进行不同传感器之间的信息融合并对***误差进行估计与反馈，从而抑制惯导***误差的发散，卡尔曼滤波器的构建步骤参见参考文献《基于二维激光多普勒测速仪的车载组合导航***》(陈红江，聂晓明，王梦成，《红外与激光工程》，2018.12)；
S5:根据步骤S4可以稳定输出高精度的实时姿态矩阵
利用S2标定完成的姿态矩阵/>
通过(9)式计算得到稳定的高精度实时姿态矩阵/>
将(10)式展开，某一导航时刻激光多普勒测速仪速度在导航坐标系n系下各个方向上的投影为：
上式中，
为某一导航时刻激光多普勒测速仪在导航坐标系n系的东、北、天三个方向上的速度投影，/>
为某一导航时刻激光多普勒测速仪在载体坐标系b系的x、y、z轴三个方向上的速度投影；
将激光多普勒测速仪速度
进行如下计算，得到任意导航时刻载体的位置信息：/>
上式中，T为激光多普勒测速仪的速度更新周期，
分别为某一导航时刻航迹推算得到的载体的纬度、经度和高程信息，/>
分别为上一导航时刻航迹推算得到的载体的纬度、经度和高程信息，其中起始点位置L0、λ0、h0由地标点给出，RE、RN分别为载体所在位置的卯酉圈半径和子午圈半径；
最后，经过(12)式中第三式，可以连续测得载体行驶过程中的高程信息。
本发明还提供一种基于上述方法的连续高程测量***，包括惯性测量单元(Inertial Measurement Unit,IMU)、转位机构、激光多普勒测速仪、UPS电源以及导航计算机，其中，惯性测量单元安装在转位机构上，组成单轴旋转惯导***(RINS)，用于敏感载体(例如实验车)的角运动和线运动；惯性测量单元分别与激光多普勒测速仪和导航计算机连接；激光多普勒测速仪与导航计算机连接，UPS电源分别与单轴旋转惯导***和激光多普勒测速仪连接；为了提高高程测量精度，以惯性测量单元的脉冲输出为基准去触发激光多普勒测速仪的输出，预防惯性测量单元与激光多普勒测速仪内部晶振不一致导致的数据丢失现象。
为了延长连续高程测量***在工程应用中的寿命，***中的转位机构采用转停而非连续旋转的旋转方案；所述转停方案为0°、180°、270°、90°四位置转停。
为了降低设计复杂度，***采用基于固态探测体的激光多普勒测速仪，不需要人为掺杂示踪粒子，而是利用探测体表面的自然颗粒。
与现有技术相比，本发明的优点在于：
1.本发明以单轴旋转惯导为核心，利用单轴旋转惯导可以自动补偿如激光陀螺常值漂移、加速度计零偏以及安装误差等***误差，为测速仪的高精度速度转换提供了良好基础
2.本发明的高程测量方法完全不依赖GNSS信号，属于全自主式连续高程测量，在密林、山谷以及极端天气等环境中仍可保持较高的连续高程测量精度，极大地提高了连续高程测量的环境适应能力；
3.为了防止晶振不一致导致单轴旋转惯导***和激光多普勒测速仪的数据采集频率不完全一致，以惯性测量单元的脉冲输出去触发激光多普勒测速仪的输出，进一步提高了连续高程测量的精度。
附图说明
为了更加清晰地描述本发明的技术方案，下面结合附图对其作进一步阐述。
图1本发明***的组成原理示意图
图2本发明***的安装示意图
图中数字说明：1-激光多普勒测速仪；2-转位机构；3-惯性测量单元；4-全球定位***；5-导航计算机；6-UPS电源；
图3车载连续高程测量实验路径示意图
图4车载连续高程测量实验中的高程变化示意图
图5转位机构的转动规律示意图
图6车载连续高程测量实验中的高程测量误差变化示意图
具体实施方法
为了使本发明的技术方案及优点更加清楚明白，现结合附图及实施例，对本发明进一步详细说明。应当理解，此处所描述的具体实施例仅用于解释本发明，并不用于限定本发明。
本发明的可行性可以通过车载实验进行验证：
实验采用的单轴旋转惯导***(由惯性测量单元和转位机构组成)陀螺零偏稳定性为0.002°/h，加速度计零偏稳定性为50μg，定位精度优于0.5nm/1h；激光多普勒测速仪测速精度优于0.05％，输出频率为100Hz，UPS电源额定功率为5400W，输出电压为110～220V，导航计算机为常规的笔记本电脑，***的组成原理如图1所示；为了方便比较，采用差分全球点位***(Global Positioning System,GPS)提供位置参考基准(输出频率1Hz，单点状态下高程定位精度3m，差分状态下高程定位精度4cm)。
惯导***安装在试验车车体内，激光测速仪安装于车底，GPS接收机和天线位于车顶，图2所示***的安装示意图。
实验地点选择湖南省长沙市黄兴大道，其实验路径示意图如图3所示，实验过程中的真实高程变化情况如图4所示。
在进入测量之前，首先对转位机构的转动方式进行设置，实验中转位机构采取0°、180°、270°、90°四位置的转停方式，其转动规律如图5所示。
根据本发明的连续高程测量方法中的步骤S2完成惯性测量单元坐标系与载体坐标系之间的水平倾角的标定，其标定结果为α＝45′、β＝32′。
然后采用本发明的连续高程测量方法中的步骤S3完成测速仪安装误差的标定，其中，俯仰安装角误差θ＝-1.1195°、航向安装角误差ψ＝0.3646°、比例因子K＝1.0343。
最后，根据本发明的连续高程测量方法中的步骤S4和S5完成连续高程测量，其测量过程中误差变化曲线如图6所示，其中最大的高程测量误差为1.68m，高程测量误差标准差为0.588m。
根据车载连续高程测量的实验结果可知，其测量结果可以满足基本的高程测量需求。
综上所述，本发明在于提出一种基于单轴RINS/LDV的连续高程测量***及方法，并针对其中的关键技术进行了权利要求。该发明属于全自主式车载连续高程测量，具有精度高、环境适应能力强等特点。
以上为本发明的连续高程测量***及方法，本发明的保护范围并不局限于上述实施例，凡是属于本发明思路下的技术方案均应数据本发明的保护范围。应当指出，对于本技术领域的普通技术人员来说，在不脱离本发明原理前提下的若干改进和润饰，这些改进和润饰也应该视为本发明的保护范围。
Claims (6)
1.一种基于单轴RINS/LDV组合的连续高程测量方法，基于由惯性测量单元、转位机构、激光多普勒测速仪、UPS电源以及导航计算机组成的连续高程测量***，其特征在于，该方法分为以下步骤：
S1：将惯性测量单元安装在转位机构上，组成单轴旋转惯导***，单轴旋转惯导***可以敏感载体的角运动和线运动；
将单轴旋转惯导***分别与激光多普勒测速仪和导航计算机连接；
将激光多普勒测速仪与导航计算机连接，同时将UPS电源分别与单轴旋转惯导***和激光多普勒测速仪连接；
惯性测量单元安装到转位机构上时，惯性测量单元坐标系s系与载体坐标系b系无法完全重合，在垂直方向上存在一个与转位机构的转动方式有关的规律性大转角，在水平方向上存在由安装误差引起固定的小角度水平倾角，其可以分解为两个欧拉角α、β，这也是限制单轴旋转惯导***导航精度的主要因素，其中垂直方向上的大转角是已知的，因此在进行高程测量前只需要对水平倾角进行补偿；
S2：将搭建好的***安装于载体后，首先进行静态下惯性测量单元的水平倾角标定，具体标定步骤如下：
S2.1：水平倾角标定时不需要使用激光多普勒测速仪，因此仅打开导航计算机、UPS电源以及单轴旋转惯导***进行数据采集，同时载体处于静止状态；
S2.2：通过导航计算机控制转位机构转动180°；
S2.3：利用导航计算机对惯性测量单元的输出进行姿态解算，得到惯性测量单元在初始位置和180°位置时惯性测量单元坐标系s系和导航坐标系n系之间的姿态矩阵
和
由于η2＝η1+180°，所以：
上式中，l1、l2分别为水平倾角标定期间惯性测量单元在初始位置和180°位置的时刻，η1和η2分别为惯性测量单元坐标系s系和载体坐标系b系在初始位置和180°位置时垂直方向的大转角，
分别为载体静止期间惯性测量单元在初始位置和180°位置时载体坐标系b系和导航坐标系n系之间的姿态矩阵，由于水平倾角标定期间载体一直静止，所以
与/>
相同，/>
分别为惯性测量单元在初始位置和180°位置时b系相对于s系的姿态矩阵；
S2.4：将(1)式和(2)式相加，并令
表示3×3矩阵/>
的矩阵元素，i＝1,2,3；j＝1,2,3，得到：
由于导航计算机进行惯导***的姿态解算后可以得到3×3姿态矩阵
和/>
则两姿态矩阵相加后的矩阵元素Cij是已知的；
S2.5：由(3)式得到水平倾角α和β：
根据水平倾角α、β以及任意时刻s系和b系在垂直方向上的大转角η，得到任意时刻载体坐标系和惯性测量单元坐标系之间的姿态矩阵
S3：由于激光多普勒测速仪与载体之间也存在安装误差，也需要对其进行标定，影响激光多普勒测速仪速度投影的安装误差有测速仪坐标系m系与载体坐标系b系之间的俯仰安装角误差θ、航向安装角误差ψ以及比例因子K，其标定方法如下：
S3.1：打开激光多普勒测速仪，并重启单轴旋转惯导***重新进行采样；
S3.2：首先设θ＝0、ψ＝0以及K＝1，起点处地标点A的坐标为(XA，YA，ZA)；
S3.3：经过1～2min直线运动后载体行驶到地标点B，其坐标为(XB，YB，ZB)，A到B位移大小为L1；
激光多普勒测速仪经航迹推算后的位置为C，其坐标为(XC，YC，ZC)，A到C位移大小为L2；
则标定的结果为：
S3.4：通过标定后的俯仰安装角误差θ、航向安装角误差ψ计算得到测速仪坐标系m系和载体坐标系b系之间的安装误差矩阵
/>
通过计算的测速仪坐标系m系和载体坐标系b系之间的安装误差矩阵
以及比例因子K，得到某一导航时刻激光多普勒测速仪速度在b系下的投影：
式中，l3为打开测速仪和重启惯导***后数据采样的时刻，
为某一导航时刻激光多普勒测速仪测量的速度在测速仪坐标系m系下投影，由激光多普勒测速仪提供；
S4：完成测速仪的安装误差标定后直接进入高程测量；
进入高程测量后，导航计算机对测量过程中惯性测量单元的输出进行姿态解算，得到实时的3×3姿态矩阵
根据S2标定完成的姿态矩阵/>
计算得到载体坐标系与导航坐标系之间的实时姿态矩阵/>
通过实时姿态矩阵
进一步得到某一导航时刻测速仪速度在导航坐标系n系下的投影/>
S5:根据步骤S4可以稳定输出高精度的实时姿态矩阵
利用S2标定完成的姿态矩阵/>
通过(9)式计算得到稳定的高精度实时姿态矩阵/>
将(10)式展开，某一导航时刻激光多普勒测速仪速度在导航坐标系n系下各个方向上的投影为：
上式中，
为某一导航时刻激光多普勒测速仪在导航坐标系n系的东、北、天三个方向上的速度投影，/>
为某一导航时刻激光多普勒测速仪在载体坐标系b系的x、y、z轴三个方向上的速度投影；
将激光多普勒测速仪速度
进行如下计算，得到任意导航时刻载体的位置信息：
上式中，T为激光多普勒测速仪的速度更新周期，
分别为某一导航时刻航迹推算得到的载体的纬度、经度和高程信息，/>
分别为上一导航时刻航迹推算得到的载体的纬度、经度和高程信息，其中起始点位置L0、λ0、h0由地标点给出，RE、RN分别为载体所在位置的卯酉圈半径和子午圈半径；
最后，经过(12)式中第三式，可以连续测得载体行驶过程中的高程信息。
2.一种根据权利要求2所述基于单轴RINS/LDV组合的连续高程测量方法，基于由惯性测量单元、转位机构、激光多普勒测速仪、UPS电源以及导航计算机组成的连续高程测量***，其特征在于：为了得到稳定的高精度实时姿态矩阵
必须借助激光多普勒测速仪对惯导***的天向进行阻尼，通常选择卡尔曼滤波器进行不同传感器之间的信息融合并对***误差进行估计与反馈，从而抑制惯导***误差的发散。
3.一种基于权利要求1或2所述方法的连续高程测量***，其特征在于：包括惯性测量单元、转位机构、激光多普勒测速仪、UPS电源以及导航计算机，其中，惯性测量单元安装在转位机构上，组成单轴旋转惯导***，用于敏感载体的角运动和线运动；惯性测量单元分别与激光多普勒测速仪和导航计算机连接；激光多普勒测速仪与导航计算机连接，UPS电源分别与单轴旋转惯导***和激光多普勒测速仪连接；为了提高高程测量精度，以惯性测量单元的脉冲输出为基准去触发激光多普勒测速仪的输出，预防惯性测量单元与激光多普勒测速仪内部晶振不一致导致的数据丢失现象。
4.一种根据权利要求3所述的连续高程测量***，其特征在于：为了延长连续高程测量***在工程应用中的寿命，***中的转位机构采用转停而非连续旋转的旋转方案。
5.一种根据权利要求3所述的连续高程测量***，其特征在于：所述转停方案为0°、180°、270°、90°四位置转停方案。
6.一种根据权利要求3所述的连续高程测量***，其特征在于：为了降低设计复杂度，***采用基于固态探测体的激光多普勒测速仪，不需要人为掺杂示踪粒子，而是利用探测体表面的的自然颗粒。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202310199906.XA CN116147577B (zh) | 2023-03-06 | 2023-03-06 | 基于单轴rins/ldv组合的连续高程测量方法及*** |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202310199906.XA CN116147577B (zh) | 2023-03-06 | 2023-03-06 | 基于单轴rins/ldv组合的连续高程测量方法及*** |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN116147577A true CN116147577A (zh) | 2023-05-23 |
| CN116147577B CN116147577B (zh) | 2024-05-03 |
Family
ID=86354356
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202310199906.XA Active CN116147577B (zh) | 2023-03-06 | 2023-03-06 | 基于单轴rins/ldv组合的连续高程测量方法及*** |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN116147577B (zh) |
Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20060287824A1 (en) * | 2005-01-29 | 2006-12-21 | American Gnc Corporation | Interruption free navigator |
| CN107015259A (zh) * | 2016-01-27 | 2017-08-04 | 北京中联星通投资管理有限公司 | 采用多普勒测速仪计算伪距/伪距率的紧组合方法 |
| WO2020220729A1 (zh) * | 2019-04-29 | 2020-11-05 | 南京航空航天大学 | 基于角加速度计/陀螺/加速度计的惯性导航解算方法 |
| CN112798021A (zh) * | 2021-04-15 | 2021-05-14 | 中国人民解放军国防科技大学 | 基于激光多普勒测速仪的惯导***行进间初始对准方法 |
| WO2021253487A1 (zh) * | 2020-06-17 | 2021-12-23 | 东南大学 | 水下导航与重力测量一体化*** |
| CN114812545A (zh) * | 2022-04-19 | 2022-07-29 | 中国人民解放军国防科技大学 | 基于双激光多普勒测速仪和惯导***组合导航方法及装置 |
-
2023
- 2023-03-06 CN CN202310199906.XA patent/CN116147577B/zh active Active
Patent Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20060287824A1 (en) * | 2005-01-29 | 2006-12-21 | American Gnc Corporation | Interruption free navigator |
| CN107015259A (zh) * | 2016-01-27 | 2017-08-04 | 北京中联星通投资管理有限公司 | 采用多普勒测速仪计算伪距/伪距率的紧组合方法 |
| WO2020220729A1 (zh) * | 2019-04-29 | 2020-11-05 | 南京航空航天大学 | 基于角加速度计/陀螺/加速度计的惯性导航解算方法 |
| WO2021253487A1 (zh) * | 2020-06-17 | 2021-12-23 | 东南大学 | 水下导航与重力测量一体化*** |
| CN112798021A (zh) * | 2021-04-15 | 2021-05-14 | 中国人民解放军国防科技大学 | 基于激光多普勒测速仪的惯导***行进间初始对准方法 |
| CN114812545A (zh) * | 2022-04-19 | 2022-07-29 | 中国人民解放军国防科技大学 | 基于双激光多普勒测速仪和惯导***组合导航方法及装置 |
Non-Patent Citations (3)
| Title |
|---|
| WANG, Q: "Dynamic Calibration Technique for Inertial Navigation System based on One-dimensional Laser Doppler Velocimeter", CONFERENCE ON ADVANCED LASER MANUFACTURING TECHNOLOGY, 31 March 2016 (2016-03-31) * |
| 崔耀星;汤建勋;聂晓明;: "激光多普勒测速仪在线标定算法", 传感器与微***, no. 01, 20 January 2020 (2020-01-20) * |
| 高春峰: "一维激光多普勒测速仪/单轴旋转惯导组合车载 高程测量方法 (特邀)", 红外与激光工程, 31 December 2022 (2022-12-31) * |
Also Published As
| Publication number | Publication date |
|---|---|
| CN116147577B (zh) | 2024-05-03 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN108051866B (zh) | 基于捷联惯性/gps组合辅助水平角运动隔离的重力测量方法 | |
| CN100476360C (zh) | 一种基于星敏感器标定的深综合组合导航方法 | |
| US10309786B2 (en) | Navigational and location determination system | |
| CN102393201B (zh) | 航空遥感用位置和姿态测量***（pos）动态杆臂补偿方法 | |
| CN101701825A (zh) | 高精度激光陀螺单轴旋转惯性导航*** | |
| CN105091907B (zh) | Sins/dvl组合中dvl方位安装误差估计方法 | |
| Salychev et al. | Low cost INS/GPS integration: Concepts and testing | |
| CN101858748A (zh) | 高空长航无人机的多传感器容错自主导航方法 | |
| CN108731674B (zh) | 一种基于单轴旋转调制的惯性天文组合导航***及计算方法 | |
| CN201955092U (zh) | 一种基于地磁辅助的平台式惯性导航装置 | |
| CN102176041A (zh) | 一种基于gnss/sins组合的车辆导航监控*** | |
| CN104697520B (zh) | 一体化无陀螺捷联惯导***与gps***组合导航方法 | |
| CN107677292B (zh) | 基于重力场模型的垂线偏差补偿方法 | |
| WO2018176092A1 (en) | "low cost ins" | |
| CN105928515A (zh) | 一种无人机导航*** | |
| CN112284415A (zh) | 里程计标度误差标定方法、***及计算机存储介质 | |
| US20140249750A1 (en) | Navigational and location determination system | |
| CN116337000A (zh) | 基于sins/ldv组合的连续高程测量方法及*** | |
| CN105928519B (zh) | 基于ins惯性导航与gps导航以及磁力计的导航算法 | |
| CN105953797A (zh) | 利用单轴陀螺仪、倾角仪和里程计的组合导航装置及方法 | |
| CN116147577B (zh) | 基于单轴rins/ldv组合的连续高程测量方法及*** | |
| CN116559966A (zh) | 基于sins/ldv组合的重力测量方法及*** | |
| US10006770B2 (en) | Remote location determination system | |
| CN104567868A (zh) | 基于ins修正的机载长航时天文导航***的方法 | |
| CN115202383B (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 |