CN111089587B - 一种倾斜rtk航向初始化方法 - Google Patents
一种倾斜rtk航向初始化方法 Download PDFInfo
- Publication number
- CN111089587B CN111089587B CN201911380356.1A CN201911380356A CN111089587B CN 111089587 B CN111089587 B CN 111089587B CN 201911380356 A CN201911380356 A CN 201911380356A CN 111089587 B CN111089587 B CN 111089587B
- Authority
- CN
- China
- Prior art keywords
- rtk
- ins
- imu
- trajectory
- track
- 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
- 238000011423 initialization method Methods 0.000 title abstract description 8
- 238000000034 method Methods 0.000 claims abstract description 42
- 238000004364 calculation method Methods 0.000 claims abstract description 13
- 238000005259 measurement Methods 0.000 claims abstract description 13
- 239000013598 vector Substances 0.000 claims description 29
- 239000011159 matrix material Substances 0.000 claims description 16
- 230000009466 transformation Effects 0.000 claims description 13
- 238000013519 translation Methods 0.000 claims description 13
- 230000008859 change Effects 0.000 claims description 6
- 230000003068 static effect Effects 0.000 claims description 5
- 206010034719 Personality change Diseases 0.000 claims description 3
- 230000036962 time dependent Effects 0.000 claims description 2
- 238000011065 in-situ storage Methods 0.000 abstract description 2
- 230000008569 process Effects 0.000 description 7
- 238000006243 chemical reaction Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 101150073669 NCAN gene Proteins 0.000 description 1
- 238000007792 addition Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 230000000694 effects 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
- 238000012545 processing 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
- 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/183—Compensation of inertial measurements, e.g. for temperature effects
-
- 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
- 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/183—Compensation of inertial measurements, e.g. for temperature effects
- G01C21/188—Compensation of inertial measurements, e.g. for temperature effects for accumulated errors, e.g. by coupling inertial systems with absolute positioning systems
-
- 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/20—Instruments for performing navigational calculations
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
-
- 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
- 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/48—Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system
- G01S19/49—Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system whereby the further system is an inertial position system, e.g. loosely-coupled
-
- 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
-
- 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/43—Determining position using carrier phase measurements, e.g. kinematic positioning; using long or short baseline interferometry
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Computer Networks & Wireless Communication (AREA)
- Manufacturing & Machinery (AREA)
- Navigation (AREA)
Abstract
本发明提出了一种倾斜RTK应用场景下通过匹配RTK轨迹与INS轨迹计算INS初始航向角误差的方法,能够在2s内实现精度为1deg的航向角初始化。本发明提出的INS轨迹推算方法不使用加速度计,并且在测量开始阶段通过静止扣除大的零偏初值,保证了INS解算轨迹的精度。同时,本发明的方法操作简单、易于实现,只需原地来回晃动测量杆即可,超快速的初始化时间也大大地提高了测量效率。与一般倾斜RTK航向初始化方法相比,本发明的方法不需使用磁力计,不会受到磁场干扰,在复杂环境中具有更强的适应性。
Description
技术领域
本发明属于MEMS INS/GNSS组合导航***航向初始化领域,特别涉及一种针对倾斜RTK的快速精确的航向初始化方法。
背景技术
惯性导航***(inertial navigation system,INS)是推算导航***的范例,具有自主性完全、可靠性高、动态性能好等优点,然而由于其误差会随时间不断积累,常常需要其他的导航手段进行辅助与校正。与INS相比,全球卫星导航定位***(global navigationsatellite system,GNSS)可以实现长时间较高精度的定位,误差不随时间积累;但也具有输出频率低、无法进行连续定位、无法输出姿态信息等缺点。将二者结合在一起,组成INS/GNSS组合导航***,可以提供连续、高带宽、长时和短时精度均较高的、完整的导航参数。
INS/GNSS组合导航***可应用于众多领域,以倾斜RTK应用场景为例,加入低成本的微机械(micro-electro-mechanical system,MEMS)惯导器件,即可组成MEMS INS/GNSS组合导航***;利用MEMS INS输出的姿态信息进行倾斜补偿,能够打破传统的RTK测量模式,大大提高作业效率。
传统GNSS RTK(real-time kinematic)能够达到厘米级的定位精度,可用于高精度位置测绘。但是在传统RTK测量过程中,需要严格对中并扶直测量杆,这不仅使得有些点(墙根点、地下管道管口内侧点等)无法进行测绘,还会导致作业效率低下。近两年,通过在RTK设备中集成惯性测量单元形成的“倾斜RTK”,可依靠INS或GNSS/INS组合给出的姿态角将天线相位中心的位置坐标补偿至杆尖,从而确定困难点的坐标,实现了可倾斜的RTK测量。倾斜RTK在测量过程中测量杆无需保持竖直,也无需长时间静止,在拓展RTK应用范围的同时也大大地提高了测量效率。
包括倾斜RTK在内的GNSS/INS组合导航***的应用过程中,航向初始化是一个关键点。由于INS的导航解算需要利用前一次的导航结果作为初始值,在首个历元解算时就必须进行初始化处理。对于INS而言,位置和速度的初始化较为简单,可以直接由外部信息源(如GNSS)提供;而姿态初始化较为复杂,一般由外部信息提供或者通过自对准获得。载体静止时,除了精度极低的惯导***外,其他类型的INS均可通过自对准实现横滚角与俯仰角的初始化,其本质是利用加速度计感知重力矢量。在姿态初始化过程中,最为困难的是航向角初始化。自对准通过陀螺感知地球自转矢量来确定北方向,此种方法对陀螺精度要求极高,陀螺零偏必须小于地球自转角速度15deg/h,尤其不适用于低成本低精度的MEMS INS。同时,由外部信息源获取的航向角精度并不理想,比如磁力计极易受到外部磁场的电磁干扰,而多天线GNSS定姿结果也常常包含着很大的噪声。
当然,对于某些特定的应用场景,可以使用特定的航向初始化方法:比如对绝大多数的车载导航而言,可以通过动对准进行航向初始化,此方法要求在车辆不转弯时按一定速度行驶且前进方向与载体x轴对齐。而在低速运动(如农用拖拉机)和手持设备的应用过程中,航向初始化仍然是一个关键点和亟需解决的问题。以倾斜RTK应用场景为例,思拓力的最新一代倾斜RTK测量仪S6Ⅱ通过磁校准确定北方向,容易受到磁场的干扰和影响;华测的惯导RTK需要手持设备前进10米,利用GNSS的位置与速度完成寻北。现有方案存在两个明显的缺点:一是使用磁力计寻北容易受到磁场干扰,可靠性较差;二是初始化时间较长,需要数秒至十几秒,且需要运动数米至十几米后才能使航向初始化精度达到可用水平,效率有待提高。
综上,在倾斜RTK应用场景中,通过INS或GNSS/INS提供测量杆精确的三轴姿态至关重要。由于MEMS INS无法进行自寻北(即航向初始化),因此如何快速,精准地获得INS的初始姿态是需要解决的关键问题。本发明以倾斜RTK实例,包括但不限于此应用场景,提出一种简单有效的航向初始化方法。
发明内容
针对低速运动和手持设备的应用过程中INS航向快速准确初始化的需求以及现有技术所存在的不足,本发明提出了一种倾斜RTK应用场景下基于轨迹匹配原理确定INS初始航向误差的方法,实现精度为1deg的航向角初始化,可在2s之内完成航向初始化。
本发明采用如下的技术方案:一种基于轨迹匹配原理确定INS初始航向误差的方法,主要是通过晃动测量杆形成一段IMU的运动轨迹线,计算该运动轨迹的RTK轨迹与INS轨迹的角度偏差,得到INS的初始航向误差;所述的技术方案包括以下步骤:
步骤1,将测量杆平放于平坦整洁的地面上,静止m分钟,用于确定大的陀螺零偏初值;
步骤2,扶起测量杆,杆尖触地,倾斜测量杆准备开始晃动,晃动开始前保持静止m秒,用于确定初始的横滚角和俯仰角;
步骤3,测量杆触地,杆尖保持不动,顶端晃动,形成一段运动轨迹线,称之为IMU轨迹线,然后通过如下步骤解算获得INS初始航向误差;
31)通过RTK解算得到天线相位中心的位置,并将上述位置投影到IMU中心,形成一段轨迹线,称之为RTK轨迹;
32)利用定位传感器的测量值解算IMU中心的位置,形成一段轨迹线,称之为INS轨迹;
33)通过匹配RTK轨迹与INS轨迹,计算出INS的初始航向角误差。
进一步的,步骤32)得到具体实现方式如下,
倾斜RTK的IMU位置与测量杆底端触底部位的位置关系描述如下:
式中,n表示当地坐标系n系,n系是以IMU相位中心为原点,x轴平行于当地水平面指向正北,y轴平行于当地水平面指向正东,z轴垂直于当地水平面向下,三者构成右手系;b表示载体坐标系b系,b系是以IMU相位中心为原点,x轴指向载体前进方向,y轴垂直于x轴指向载体右侧,z轴与x轴和y轴垂直并构成右手系;表示测量杆触地点的位置向量,投影在n系,T表示杆尖;表示IMU位置向量在n系下的投影;为姿态矩阵;lb为IMU中心指向触地点的向量,在b系下的投影;
进一步将IMU的位置推算公式改写为
其中,Δθk和Δθk-1分别是当前时刻和上一时刻的陀螺角增量输出。
进一步的,步骤33)的具体实现方式如下,
将RTK轨迹所确定的坐标系记为参考坐标系r系,将INS轨迹所确定的坐标系记为计算坐标系c系,r系与c系简化为两个共面的二维坐标系,两个坐标系之间的夹角即为初始航向角误差,选择三参数:初始航向角误差θ、北向平移距离N、东向平移距离E,构建如下坐标转换矩阵:
式中,si,r,si,c分别是RTK轨迹与INS轨迹坐标序列的平面投影,i表示第i个点,i=1,2,3,4…n;Δ是观测误差;
式中,上标k表示迭代次数;
将观测方程按泰勒公式展开,舍弃二阶项和高阶项得:
上式简化为:
写成残差方程的形式,则为:
通过最小二乘法得到解算结果:
x=(HTH)-1HTz (12)
Xk=Xk-1+xk (13)
其中,最小二乘法的初值通过向量匹配法获得。
进一步的,最小二乘法的初值通过如下方式获得,
通过选取RTK轨迹和INS轨迹上相同历元下的对应点,组成多对向量,求出多对向量的夹角后,赋予多对向量的夹角不同的权重,确定出一个初始航向角误差的角度值。
进一步的,所述m的取值为1。
本发明具有以下有益效果:
(1)本发明通过匹配RTK轨迹与INS轨迹计算INS的初始航向误差。RTK轨迹的精度高,其误差认为可忽略,因此航向角精度主要受到INS轨迹精度的影响。本发明提出的INS轨迹推算方法不使用加速度计,从而避免了加速度计误差对定位精度的影响,并使得INS轨迹的误差主要来源于常值陀螺零偏,而大的陀螺零偏初值,可以通过开始阶段的静止确定并扣除。因此本发明能够实现精度为1deg的航向角初始化,对于上述应用场景而言已经达到相当可观的精度。
(2)本发明的方法操作简单、易于实现。原地晃动测量杆时,理论上晃动幅度(指顶端IMU的运动幅度)越大越好;实际操作时由于测量杆长度为2米,晃动幅度能够很容易达到1米,已经能够达到较好的初始化效果。同时,本发明的方法对晃动速度没有要求,晃动时间也会根据***的实时解算结果反馈到终端,一般两秒左右即可完成初始化;因此操作人员不需要花费额外的精力,只需根据提示完成操作即可。
(3)本发明的方法初始化时间短,能够大大提高测量效率。现有的倾斜RTK航向初始化方法需要数秒至十几秒的时间,且需要运动数米至十几米后才能使航向初始化精度达到可用水平;而本发明的方法只需两秒即能达到1deg的初始化精度,使得作业效率得到了大幅提高。
(4)本发明的方法与一般倾斜RTK航向初始化方法相比,不需使用磁力计,不会受到磁场干扰,在复杂环境中具有更强的适应性。
附图说明
图1为倾斜RTK初始化过程中IMU的轨迹线示意图。
图2为INS轨迹与GPS RTK轨迹的相似性示意图。
具体实施方式
下面结合附图和实施例对本发明的技术方案作进一步说明。
在倾斜RTK的应用场景下,用户开机后,依据本发明的方法进行航向初始化。具体步骤如下:
1)设备开机后,将测量杆平放于平坦整洁的地面上,静止1分钟,用于确定大的陀螺零偏初值。
2)扶起测量杆,杆尖触地,倾斜测量杆准备开始晃动;晃动开始前保持静止1秒,用于确定初始的横滚角和俯仰角。
3)测量杆触地,杆尖保持不动,顶端(IMU端)晃动,形成一段运动轨迹线(称之为IMU轨迹线),如图1所示。此时***进行实时解算,当航向精度可靠时给出提示,用户可停止晃动。一般只需晃动2秒左右即可确定INS初始航向。
所述的***实时解算进一步包括以下子步骤:
31)通过RTK解算得到天线相位中心的位置,并将上述位置投影到IMU中心,形成一段轨迹线(称之为RTK轨迹)。
32)利用定位传感器的测量值解算IMU中心的位置,形成一段轨迹线(称之为INS轨迹);本发明提出如下解算方法确定INS轨迹:
倾斜RTK的IMU位置与测量杆底端触底部位的位置关系描述如下:
式中,n表示当地坐标系n系,n系是以IMU相位中心为原点,x轴平行于当地水平面指向正北,y轴平行于当地水平面指向正东,z轴垂直于当地水平面向下,三者构成右手系;b表示载体坐标系b系,b系是以IMU相位中心为原点,x轴指向载体前进方向,y轴垂直于x轴指向载体右侧,z轴与x轴和y轴垂直并构成右手系;表示测量杆触地点的位置向量,投影在n系,T表示杆尖(杆底);表示IMU位置向量在n系下的投影;为姿态矩阵;lb为IMU中心指向触地点的向量,在IMU坐标系(b系)下的投影。其中位置采用北东地形式(平面坐标与高程)。
b系的姿态变化可以简化为:
其中,Δθk和Δθk-1分别是当前时刻和上一时刻的陀螺角增量输出。
33)假设INS轨迹只受初始航向误差的影响,忽略其他传感器误差,则INS轨迹与RTK轨迹具有高度相似性,表现为两条轨迹形状基本一致,只是旋转了一个角度,如图2所示。这个夹角即为INS的初始航向角误差。因此,通过匹配RTK轨迹与INS轨迹,计算出INS的初始航向误差,所述的轨迹匹配算法包括但不限于向量匹配法、最小二乘法等,具体实现方式如下,
将RTK轨迹所确定的坐标系记为参考坐标系r系,将INS轨迹所确定的坐标系记为计算坐标系c系,r系与c系可简化为两个共面的二维坐标系,两个坐标系之间的夹角即为初始航向角误差。选择三参数(初始航向角误差θ、北向平移距离N、东向平移距离E)转化模型实现坐标系的转换。可构建如下坐标转换矩阵:
式中,si,r,si,c分别是RTK轨迹与INS轨迹坐标序列的平面投影,i(i=1,2,3,4…n)表示第i个点;Δ是观测误差。需要注意的是,由于坐标转换矩阵包含了平移信息,因此原本是二维的si,c扩展为三维向量。
式中,上标k表示迭代次数。
将观测方程按泰勒公式展开,舍弃二阶项和高阶项,可得:
上式可简化为:
写成残差方程的形式,则为:
通过最小二乘法即可解算结果:
x=(HTH)-1HTz (25)
Xk=Xk-1+xk (26)
其中,最小二乘法的初值可以但不限于通过向量匹配法给出,具体的做法是:通过选取RTK轨迹和INS轨迹相同历元下的对应点,组成多对向量;例如,假设初始对准的开始时间9:00,,晃动2秒钟,则可以得到9:00,9:01,9:02三个时间点的坐标,相同时间点下RTK轨迹和INS轨迹上的点为对应点,任一轨迹上的这三个点一共可以组成3个向量,不同轨迹上的向量组成3对向量;理论上讲,每对向量的夹角即为两个轨迹的夹角;求出多对向量的夹角后,依据一定的准则给予权重,可以确定出一个初始航向角误差的角度值;上述准则包括但不限于向量长度、时间先后顺序等。
本文中所描述的具体实施例仅仅是对本发明精神作举例说明。本发明所属技术领域的技术人员可以对所描述的具体实施例做各种各样的修改或补充或采用类似的方式替代,但并不会偏离本发明的精神或者超越所附权利要求书所定义的范围。
Claims (4)
1.一种倾斜RTK航向初始化方法,其特征在于,包括如下步骤:
步骤1,将测量杆平放于平坦整洁的地面上,静止m分钟,用于确定大的陀螺零偏初值;
步骤2,扶起测量杆,杆尖触地,倾斜测量杆准备开始晃动,晃动开始前保持静止m秒,用于确定初始的横滚角和俯仰角;
步骤3,测量杆触地,杆尖保持不动,顶端晃动,形成一段运动轨迹线,称之为IMU轨迹线,然后通过如下步骤解算获得INS初始航向误差;
31)通过RTK解算得到天线相位中心的位置,并将上述位置投影到IMU中心,形成一段轨迹线,称之为RTK轨迹;
32)利用定位传感器的测量值解算IMU中心的位置,形成一段轨迹线,称之为INS轨迹;
33)通过匹配RTK轨迹与INS轨迹,计算出INS的初始航向角误差。
2.如权利要求1所述的一种倾斜RTK航向初始化方法,其特征在于:步骤32)得到具体实现方式如下,
倾斜RTK的IMU位置与测量杆底端触底部位的位置关系描述如下:
式中,n表示当地坐标系n系,n系是以IMU相位中心为原点,x轴平行于当地水平面指向正北,y轴平行于当地水平面指向正东,z轴垂直于当地水平面向下,三者构成右手系;b表示载体坐标系b系,b系是以IMU相位中心为原点,x轴指向载体前进方向,y轴垂直于x轴指向载体右侧,z轴与x轴和y轴垂直并构成右手系;表示测量杆触地点的位置向量,投影在n系,T表示杆尖;表示IMU位置向量在n系下的投影;为姿态矩阵;lb为IMU中心指向触地点的向量,在b系下的投影;
进一步将IMU的位置推算公式改写为
其中,Δθk和Δθk-1分别是当前时刻和上一时刻的陀螺角增量输出。
3.如权利要求1所述的一种倾斜RTK航向初始化方法,其特征在于:步骤33)的具体实现方式如下,
将RTK轨迹所确定的坐标系记为参考坐标系r系,将INS轨迹所确定的坐标系记为计算坐标系c系,r系与c系简化为两个共面的二维坐标系,两个坐标系之间的夹角即为初始航向角误差,选择三参数:初始航向角误差θ、北向平移距离N、东向平移距离E,构建如下坐标转换矩阵:
式中,si,r,si,c分别是RTK轨迹与INS轨迹坐标序列的平面投影,i表示第i个点,i=1,2,3,4…n;Δ是观测误差;
式中,上标k表示迭代次数;
将观测方程按泰勒公式展开,舍弃二阶项和高阶项得:
上式简化为:
写成残差方程的形式,则为:
通过最小二乘法得到解算结果:
x=(HTH)-1HTz (12)
Xk=Xk-1+xk (13)
其中,最小二乘法的初值通过向量匹配法获得。
4.如权利要求3所述的一种倾斜RTK航向初始化方法,其特征在于:最小二乘法的初值通过如下方式获得,
通过选取RTK轨迹和INS轨迹上相同历元下的对应点,组成多对向量,求出多对向量的夹角后,赋予多对向量的夹角不同的权重,确定出一个初始航向角误差的角度值。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911380356.1A CN111089587B (zh) | 2019-12-27 | 2019-12-27 | 一种倾斜rtk航向初始化方法 |
US17/012,794 US20210199438A1 (en) | 2019-12-27 | 2020-09-04 | Heading initialization method for tilt rtk |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911380356.1A CN111089587B (zh) | 2019-12-27 | 2019-12-27 | 一种倾斜rtk航向初始化方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111089587A CN111089587A (zh) | 2020-05-01 |
CN111089587B true CN111089587B (zh) | 2021-05-18 |
Family
ID=70398440
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911380356.1A Active CN111089587B (zh) | 2019-12-27 | 2019-12-27 | 一种倾斜rtk航向初始化方法 |
Country Status (2)
Country | Link |
---|---|
US (1) | US20210199438A1 (zh) |
CN (1) | CN111089587B (zh) |
Families Citing this family (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110514208B (zh) * | 2019-08-26 | 2021-12-03 | 广州极飞科技股份有限公司 | 飞行器的航向确定方法及装置、*** |
CN111736181A (zh) * | 2020-05-08 | 2020-10-02 | 广州南方卫星导航仪器有限公司 | 高精度测绘型gnss接收机自检方法、电子设备、介质及*** |
CN112325846B (zh) * | 2020-10-21 | 2021-07-02 | 北京航空航天大学 | 一种rtk倾斜测量精度提升方法 |
CN113514865B (zh) * | 2020-12-31 | 2022-06-28 | 上海司南卫星导航技术股份有限公司 | 一种组合导航装置的初始化方法、组合导航装置及计算机可读介质 |
CN113763751A (zh) * | 2021-03-17 | 2021-12-07 | 苏州臻迪智能科技有限公司 | 一种无人船保持通信的方法、装置、无人船及存储介质 |
CN113370236B (zh) * | 2021-07-07 | 2024-03-01 | 深圳海外装饰工程有限公司 | 标线机器人及其***和标线制控制方法、以及存储介质 |
CN114383631B (zh) * | 2021-12-10 | 2024-06-21 | 中国兵器工业集团第二一四研究所苏州研发中心 | 基于最小二乘、泰勒展开和综合残差组合的实时标定方法 |
CN114264302B (zh) * | 2021-12-14 | 2024-01-30 | 新纳传感***有限公司 | 倾斜测量设备及其的惯性导航***的初始化方法 |
CN115096332B (zh) * | 2022-06-17 | 2024-06-14 | 西安微电子技术研究所 | 一种大角度范围的高精度垂直发射对准方法、设备及介质 |
CN114947627B (zh) * | 2022-08-01 | 2022-11-22 | 深圳市云鼠科技开发有限公司 | 扫地机imu初始化的判定方法、装置、设备及存储介质 |
CN114994732B (zh) * | 2022-08-04 | 2022-11-01 | 武汉大学 | 基于gnss载波相位的车载航向快速初始化装置及方法 |
CN118225032A (zh) * | 2024-05-24 | 2024-06-21 | 吉林大学 | 地面运动载体磁干扰条件下的航向角测量误差校正方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102590842A (zh) * | 2012-02-22 | 2012-07-18 | 武汉大学 | 一种gnss/imu一体化天线 |
CN109814133A (zh) * | 2019-03-07 | 2019-05-28 | 上海华测导航技术股份有限公司 | Gnss接收机倾斜测量***、方法、装置和存储介质 |
CN110017849A (zh) * | 2019-04-18 | 2019-07-16 | 菲曼(北京)科技有限公司 | 一种基于gnss接收机和imu传感器的测绘一体机的倾斜测量方法 |
CN110133694A (zh) * | 2019-04-18 | 2019-08-16 | 同济大学 | 基于双天线gnss航向和轮速辅助的车辆定位方法及*** |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20090024325A1 (en) * | 2007-07-19 | 2009-01-22 | Scherzinger Bruno M | AINS enhanced survey instrument |
-
2019
- 2019-12-27 CN CN201911380356.1A patent/CN111089587B/zh active Active
-
2020
- 2020-09-04 US US17/012,794 patent/US20210199438A1/en not_active Abandoned
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102590842A (zh) * | 2012-02-22 | 2012-07-18 | 武汉大学 | 一种gnss/imu一体化天线 |
CN109814133A (zh) * | 2019-03-07 | 2019-05-28 | 上海华测导航技术股份有限公司 | Gnss接收机倾斜测量***、方法、装置和存储介质 |
CN110017849A (zh) * | 2019-04-18 | 2019-07-16 | 菲曼(北京)科技有限公司 | 一种基于gnss接收机和imu传感器的测绘一体机的倾斜测量方法 |
CN110133694A (zh) * | 2019-04-18 | 2019-08-16 | 同济大学 | 基于双天线gnss航向和轮速辅助的车辆定位方法及*** |
Also Published As
Publication number | Publication date |
---|---|
CN111089587A (zh) | 2020-05-01 |
US20210199438A1 (en) | 2021-07-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111089587B (zh) | 一种倾斜rtk航向初始化方法 | |
US11598886B2 (en) | GNSS/IMU surveying and mapping system and method | |
US9541392B2 (en) | Surveying system and method | |
CN108700416B (zh) | 改进的测量杆 | |
CN103917850B (zh) | 一种惯性导航***的运动对准方法 | |
EP3933166A1 (en) | Attitude measurement method | |
US20200379127A1 (en) | Methods, apparatuses, and computer programs for estimating the heading of an axis of a rigid body | |
Wu et al. | Self-calibration for IMU/odometer land navigation: Simulation and test results | |
CN105091907B (zh) | Sins/dvl组合中dvl方位安装误差估计方法 | |
CN109269471A (zh) | 一种新型gnss接收机倾斜测量***及方法 | |
CN104501838B (zh) | 捷联惯导***初始对准方法 | |
CN109186597B (zh) | 一种基于双mems-imu的室内轮式机器人的定位方法 | |
CN109596144B (zh) | Gnss位置辅助sins行进间初始对准方法 | |
CN105571578B (zh) | 一种利用伪观测取代精密转台的原地旋转调制寻北方法 | |
CN112562077B (zh) | 一种融合pdr和先验地图的行人室内定位方法 | |
JP2012173190A (ja) | 測位システム、測位方法 | |
CN116067394A (zh) | 一种***性调制惯导***误差的方法及终端 | |
Jin et al. | Fast and accurate initialization for monocular vision/INS/GNSS integrated system on land vehicle | |
CN113532477A (zh) | 一种骑行码表设备及骑行码表初始姿态自动校准方法 | |
CN109945857B (zh) | 一种面向不动产实地测量的车载惯性定位方法及其装置 | |
CN114994732B (zh) | 基于gnss载波相位的车载航向快速初始化装置及方法 | |
Hayal | Static calibration of the tactical grade inertial measurement units | |
CN115717901B (zh) | 基于滤波的惯性/视觉里程计安装误差估计方法 | |
CN115752395A (zh) | 一种具备惯性自主定位能力的测量棱镜及棱镜跟踪方法 | |
CN114488243A (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 |