CN110133692A - 惯导技术辅助的高精度gnss动态倾斜测量系统及方法 - Google Patents

惯导技术辅助的高精度gnss动态倾斜测量系统及方法 Download PDF

Info

Publication number
CN110133692A
CN110133692A CN201910311556.5A CN201910311556A CN110133692A CN 110133692 A CN110133692 A CN 110133692A CN 201910311556 A CN201910311556 A CN 201910311556A CN 110133692 A CN110133692 A CN 110133692A
Authority
CN
China
Prior art keywords
observation point
moment
gnss
information
angle
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
Application number
CN201910311556.5A
Other languages
English (en)
Other versions
CN110133692B (zh
Inventor
张践
马骏
熊东旭
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Firmament Wuhan Electron Equipment Co Ltd
Original Assignee
Firmament Wuhan Electron Equipment Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Firmament Wuhan Electron Equipment Co Ltd filed Critical Firmament Wuhan Electron Equipment Co Ltd
Priority to CN201910311556.5A priority Critical patent/CN110133692B/zh
Publication of CN110133692A publication Critical patent/CN110133692A/zh
Application granted granted Critical
Publication of CN110133692B publication Critical patent/CN110133692B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C9/00—Measuring inclination, e.g. by clinometers, by levels
    • 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/40—Correcting position, velocity or attitude
    • 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

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Navigation (AREA)

Abstract

本发明提出一种惯导技术辅助的高精度GNSS动态倾斜测量系统及方法，所述系统包括GNSS板卡和惯导模块，所述惯导模块包括处理器、以及分别与所述处理器通信连接的角速度传感器、加速度传感器、PPS脉冲时钟；所述GNSS板卡用于测量观测点的定位信息；所述处理器根据传感器测量值计算得到观测点的位置、姿态、速度信息；建立惯性导航与GNSS定位组合的状态方程，利用卡尔曼滤波估计角速度传感器、加速度传感器的误差并实时的进行误差补偿，得到修正后的姿态角；根据所述观测点的定位信息、修正后的姿态角以及杆长计算出测量点的位置。本发明提出的系统和方法对测量设备不再要求严格的对中，系统会自动修正坐标值，降低了人为误差，提高测量的效率。

Description

惯导技术辅助的高精度GNSS动态倾斜测量系统及方法
技术领域
本发明属于卫星导航定位技术领域，具体涉及一种惯导技术辅助的高精度 GNSS动态倾斜测量系统及方法。
背景技术
全球导航卫星系统(GNSS)是能在地球表面或近地空间的任何地点为用户提供全天候的3维坐标和速度以及时间信息的空基无线电导航定位系统。 GNSS技术目前已基本取代了地基无线电导航、传统大地测量和天文测量导航定位技术，并推动了大地测量与导航定位领域的全新发展。
目前用GNSS做高精度测量时，需要将GNSS设备垂直放置于测量点位置上方，设备均需调整到水平，这就需要对中。由于受到地磁和周边环境的影响，采集的数据存在不稳定性，同时由于校准时需要繁杂的操作步骤，容易导致业务人员校准失败，当需要大量多点测量时，这种方式严重影响测量效率，甚至有的需要倾斜测量的点无法直接测量，只能间接测量，需要辅助手段将间接测量值转换到测量点。这就导致了对测量人员要有一定技术要求，并给测量人员带来大量额外工作，测量人员也容易出现人为误差导致测量精度出现问题甚至错误。
发明内容
本发明提出一种惯导技术辅助的高精度GNSS动态倾斜测量系统及方法，用于解决现有GNSS测量中需要对中给测量人员带来的不便以及测量效率低下、测量误差大的问题。
本发明第一方面，提供一种惯导技术辅助的高精度GNSS动态倾斜测量系统，所述系统包括GNSS板卡和惯导模块，所述惯导模块包括处理器、以及分别与所述处理器通信连接的角速度传感器、加速度传感器、PPS脉冲时钟；
所述GNSS板卡用于测量观测点的定位信息，并将所述观测点的定位信息发送至所述惯导模块的处理器；
所述PPS脉冲时钟将所述角速度传感器、加速度传感和所述GNSS板卡的数据通过脉冲信号校准，实现数据时间上的同步；
所述处理器根据角速度传感器测量值、加速度传感器测量值计算得到观测点的位置、姿态、速度信息；建立惯性导航与GNSS定位组合的状态方程，利用卡尔曼滤波估计角速度传感器、加速度传感器的误差并实时的进行误差补偿，得到修正后的姿态角；根据所述观测点的定位信息、修正后的姿态角、所述观测点和测量点之间的直杆长度计算出测量点的位置。
可选的，所述计算观测点的姿态信息具体包括：
设已知的初始位置向量信息：纬度经度λ，高度h；初始姿态角信息：航向角ψ，俯仰角θ，横滚角φ；初始速度：vn；根据所述初始姿态角信息得到初始姿态矩阵
其中Rx，Ry，Rz分别为绕x，y，z轴的单位旋转矩阵；
设角速度传感器测量值为加速度传感器测量值为和分别表示载体坐标系相对于惯性坐标系的角增量和速度增量，则载体坐标系相对于导航坐标系的角增量为：
其中，为的转置，为地球自转角速率在导航坐标系的投影，为载体运动引起的导航坐标系相对于地球旋转角速度，Δt＝tk+1-tk是时间间隔 (tk,tk+1)的增量，k为正整数；由上述公式计算出角增量表示的四元数更新方程：
其中，qk为tk时刻的四元数，qk+1为tk+1时刻的四元数；
令qk+1＝[q1,q2,q3,q4]T,将tk+1时刻的四元数qk+1转换为tk+1时刻的姿态矩阵将tk+1时刻的姿态矩阵转换成tk+1时刻的姿态角，获得tk+1时刻观测点的姿态信息，即航向角ψk+1，俯仰角θk+1，横滚角φk+1：
φk+1＝arctan2(c32,c33)
ψk+1＝arctan2(c21,c11)
其中cij代表所述姿态矩阵的第(i,j)个元素，i＝1,2,3,j＝1,2,3。
可选的，所述计算观测点的速度信息具体为：
将加速度传感器测得的载体坐标系下的速度增量转换为导航坐标系下的速度增量
则经有害加速度改正后的速度增量为Δvn：
其中γn＝(0 0 γ)T，γ为在纬度和大地高度h下的重力；为地球自转角速率在导航系的投影，为载体运动引起的导航系相对于地球旋转角速度，Δt＝tk+1-tk，vn为初始速度向量信息；
已知所述观测点初始速度为vn，所述观测点的速度信息更新公式为：：
其中为tk时刻的速度，为tk+1时刻的速度，为tk+1时刻速度增量。
可选的，所述计算观测点的位置信息具体包括：
已知初始的位置矢量为所述观测点的位置信息更新公式为：
其中为tk+1时刻的位置矢量，为tk时刻的位置矢量，M为子午圈曲率半径，N为卯酉圈曲率半径，分别为所述观测点在tk时刻、tk+1时刻的速度信息，Δt＝tk+1-tk，根据所述观测点的位置信息更新公式得到观测点的位置信息PINS。
可选的，所述惯性导航与GNSS定位组合的状态方程为：
其中，误差状态向量Xk-1、Xk分别为tk-1时刻、tk时刻的误差状态向量；所述误差状态向量中，φ为姿态角误差矢量，δvn是速度误差矢量，δp是位置误差矢量，εb角速度传感器测量零漂，为加速度传感器测量零偏；F为tk-1时刻到tk时刻的状态转移矩阵，I为单位矩阵，Hk为 tk时刻的观测系数矩阵，Δt＝tk-tk-1；Zk为观测量，PINS为根据角速度传感器测量值、加速度传感器测量值计算得到观测点的位置，PGNSS为GNSS板卡测量到的观测点定位信息，Vk为量测噪声。
可选的，所述测量点的位置Pr计算方法为：
其中，为为纬度，h为高度，M为子午圈曲率半径，N为卯酉圈曲率半径；PGNSS为GNSS测量到的观测点定位信息，为根据所述卡尔曼滤波估计得到的所述修正后的姿态角转换成的方向余弦阵，δl＝[0,0,-l]，l为观测点与测量点之间的直杆长度。
本发明第二方面，提出一种惯导技术辅助的高精度GNSS动态倾斜测量方法，所述方法包括：
S1、通过GNSS测量观测点定位信息，并进行PPS脉冲时钟校准；
S2、通过角速度传感器测量值、加速度传感器测量值计算观测点的位置、姿态、速度信息；
S3、建立惯性导航与GNSS定位组合的状态方程，利用卡尔曼滤波估计角速度传感器、加速度传感器的误差并实时的进行误差补偿，得到修正后的姿态角信息；
S4、根据所述观测点的定位信息、卡尔曼滤波估计得到的观测点修正后的姿态角信息、所述观测点和测量点之间的直杆长度计算出测量点的位置。
可选的，所述步骤S2具体为：
S21、计算所述观测点的姿态信息
设获取到的观测点的初始定位信息为：初始位置向量信息：纬度经度λ，高度h；初始姿态角信息：航向角ψ，俯仰角θ，横滚角φ；初始速度：vn；根据所述初始姿态角信息得到初始姿态矩阵
其中Rx，Ry，Rz分别为绕x，y，z轴的单位旋转矩阵；
设角速度传感器测量值为加速度传感器测量值为和分别表示载体坐标系相对于惯性坐标系的角增量和速度增量，则载体坐标系相对于导航坐标系的角增量为：
其中，为的转置，为地球自转角速率在导航坐标系的投影，为载体运动引起的导航坐标系相对于地球旋转角速度，Δt＝tk+1-tk是时间间隔 (tk,tk+1)的增量，由此计算出旋转角增量表示的四元数更新方程：
其中，qk为tk时刻的四元数，qk+1为tk+1时刻的四元数； 令qk+1＝[q1,q2,q3,q4]T,将tk+1时刻的四元数qk+1转换为tk+1时刻的姿态矩阵然后将tk+1时刻的姿态矩阵转换成tk+1时刻的姿态角，获得tk+1时刻观测点的姿态信息，即航向角ψk+1，俯仰角θk+1，横滚角φk+1：
φk+1＝arctan2(c32,c33)
ψk+1＝arctan2(c21,c11)
其中cij代表姿态矩阵的第(i，j)个元素，i＝1,2,3,j＝1,2,3；
S22、计算观测点的速度信息
将加速度传感器测得的载体坐标系下的速度增量转换为导航坐标系下的速度增量
则经有害加速度改正后的速度增量为Δvn：
其中γn＝(0 0 γ)T，γ为在纬度和大地高度h下的重力；为地球自转角速率在导航系的投影，为载体运动引起的导航系相对于地球旋转角速度，Δt＝tk+1-tk，vn为初始速度向量信息；
已知所述观测点初始速度为vn，所述观测点的速度信息更新公式为：
其中为tk时刻的速度，为tk+1时刻的速度，为tk+1时刻速度增量；
S23、计算观测点的位置信息
已知初始的位置矢量为所述观测点的位置信息更新公式为：
其中为tk+1时刻的位置矢量，为tk时刻的位置矢量，M为子午圈曲率半径， N为卯酉圈曲率半径，分别为所述观测点在tk时刻、tk+1时刻的速度信息，Δt＝tk+1-tk。
可选的，所述步骤S3中，所述状态方程为：
其中，误差状态向量Xk-1、Xk分别为tk-1时刻、tk时刻的误差状态向量；所述误差状态向量中，φ为姿态角误差矢量，δvn是速度误差矢量，δp是位置误差矢量，εb角速度传感器测量零漂，为加速度传感器测量零偏；F为tk-1时刻到tk时刻的状态转移矩阵，I为单位矩阵，Hk为 tk时刻的观测系数矩阵，Δt＝tk-tk-1；Zk为观测量，PINS为根据所述观测点的位置信息更新公式得到的观测点的位置，PGNSS为GNSS板卡测量到的观测点定位信息，Vk为量测噪声。
可选的，所述测量点的位置Pr计算方法为：
Pr＝PGNSS-MpvCnδl
其中， 为纬度，h为高度，M为子午圈曲率半径，N为卯酉圈曲率半径；PGNSS为GNSS测量到的观测点定位信息，为根据所述卡尔曼滤波估计得到的所述修正后的姿态角转换成的方向余弦阵，δl＝[0,0,-l]，l为观测点与测量点之间的直杆长度。
本发明惯性导航技术和GNSS定位技术为基础，提出了惯导技术辅助的高精度GNSS动态倾斜测量系统和方法，实现测量的倾斜改正，对测量设备不再要求严格的对中，测量人员无需严格保持设备水平即可进行数据采集，系统会自动修正坐标值，从而降低了对测量人员的要求、降低了人为误差，提高了测量的效率，增加了数据可靠性。
附图说明
为了更清楚地说明本发明的技术方案，下面将对本发明技术描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动性的前提下，还可以根据这些附图获得其他的附图。
图1为本发明实施例提供的系统结构示意图；
图2为本发明实施例提供的系统中处理器的处理流程示意图；
图3为本发明实施例提供的方法流程示意图。
具体实施方式
本发明提出一种惯导技术辅助的高精度GNSS动态倾斜测量系统和方法，对测量设备不再要求严格的对中，系统会自动修正坐标值，实现倾斜状态下的高精度测量，从而降低了对测量人员的要求、降低人为误差，提高测量的效率。
为使得本发明的发明目的、特征、优点能够更加的明显和易懂，下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，下面所描述的实施例仅仅是本发明一部分实施例，而非全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其它实施例，都属于本发明保护的范围。
请参见图1，本发明提出一种惯导技术辅助的高精度GNSS动态倾斜测量系统，所述系统包括GNSS板卡110和惯导模块120，所述惯导模块120包括处理器1201、以及分别与所述处理器通信连接的角速度传感器1203、加速度传感器1204、PPS脉冲时钟1202；
GNSS板卡110通过串口与处理器1201通信，PPS脉冲时钟1202通过I/O 口与处理器时钟同步，所述角速度传感器1203、加速度传感器1204构成惯性测量单元IMU，均通过12C总线与处理器1201通信；在惯性导航系统中，惯性测量单元可通过载体运动角速度和加速度，经过积分运算获得载体姿态、速度和位置，从而实现导航定位。
所述GNSS板卡110用于测量观测点的定位信息，并将所述观测点的定位信息发送至所述惯导模块的处理器1201；本发明所述观测点即为GNSS设备的天线相位中心，GNSS设备直杆底部即为测量点，可认为观测点和测量点之间通过固定长度的直杆刚体连接。
所述PPS脉冲时钟1202将所述角速度传感器1203、加速度传感器1204 和所述GNSS板卡110的数据通过脉冲信号校准，实现数据时间上的同步；
所述处理器根据角速度传感器1203测量值、加速度传感器1204测量值计算得到观测点的位置、姿态、速度信息；建立惯性导航与GNSS定位组合的状态方程，利用卡尔曼滤波估计角速度传感器1203、加速度传感器1204的误差并实时的进行误差补偿，得到修正后的姿态角；根据所述观测点的定位信息、修正后的姿态角、所述观测点和测量点之间的直杆长度计算出测量点的位置。
在上述系统中，所述计算观测点的姿态信息具体过程包括：
设已知的初始位置信息：纬度经度λ，高度h；初始姿态角信息：航向角ψ，俯仰角θ，横滚角φ；初始速度：vn；根据所述初始姿态角信息得到初始姿态矩阵
其中Rx，Ry，Rz分别为绕x，y，z轴的单位旋转矩阵；
载体坐标系是与载体固连的动坐标系，其原点取在载体质心，并构成右手坐标系。设角速度传感器测量值为加速度传感器测量值为传感器测量值均为经过误差补偿后的值，和分别表示载体坐标系相对于惯性坐标系的角增量和速度增量，则载体坐标系相对于导航坐标系的角增量为：
其中，为的转置，为地球自转角速率在导航坐标系的投影，为载体运动引起的导航坐标系相对于地球旋转角速度，Δt＝tk+1-tk是时间间隔 (tk,tk+1)的增量，k为正整数；由上述公式(2)计算出角增量表示的四元数更新方程：
其中，qk为tk时刻的四元数，qk+1为tk+1时刻的四元数；
令qk+1＝[q1,q2,q3,q4]T,将tk+1时刻的四元数qk+1转换为tk+1时刻的姿态矩阵
将tk+1时刻的姿态矩阵转换成tk+1时刻的姿态角，获得tk+1时刻观测点的姿态信息，即航向角ψk+1，俯仰角θk+1，横滚角φk+1：
φk+1＝arctan2(c32,c33)
ψk+1＝arctan2(c21,c11) (5)
其中cij代表所述姿态矩阵的第(i,j)个元素，i＝1,2,3,j＝1,2,3。
在上述系统中，所述计算观测点的速度信息具体过程为：
将加速度传感器测得的载体坐标系下的速度增量转换为导航坐标系下的速度增量
则经有害加速度改正后的速度增量为Δvn：
其中γn＝(0 0 γ)T，γ为在纬度和大地高度h下的重力：
其中各参数a1＝9.7803267715，a4＝-0.0000030876910891，a2＝0.0052790414，a5＝0.0000000043977311，a3＝0.0000232718，a6＝0.0000000000007211；为地球自转角速率在导航系的投影，为载体运动引起的导航系相对于地球旋转角速度，Δt＝tk+1-tk，vn为初始速度向量信息；为有害加速度。
已知所述观测点初始速度为vn，所述观测点的速度信息更新公式为：
其中为tk时刻的速度，为tk+1时刻的速度，为tk+1时刻速度增量。
在上述系统中，所述计算观测点的位置信息具体过程包括：
已知初始的位置矢量为所述观测点的位置信息更新公式为：
其中为tk+1时刻的位置矢量，为tk时刻的位置矢量，M为子午圈曲率半径， N为卯酉圈曲率半径，分别为所述观测点在tk时刻、tk+1时刻的速度信息，Δt＝tk+1-tk。通过所述观测点的位置信息更新公式(9)即可获得观测点位置信息PINS。
在上述系统中，所述惯性导航与GNSS定位组合的状态方程为：
其中，误差状态向量Xk-1、Xk分别为tk-1时刻、tk时刻的误差状态向量；所述误差状态向量中，φ为姿态角误差矢量，δvn是速度误差矢量，δp是位置误差矢量，εb角速度传感器测量零漂，为加速度传感器测量零偏；F为tk-1时刻到tk时刻的状态转移矩阵，I为单位矩阵，Hk为 tk时刻的观测系数矩阵，Δt＝tk-tk-1；Zk为观测量，PINS为根据所述观测点的位置信息更新公式(9)得到的观测点的位置，PGNSS为GNSS板卡测量到的观测点定位信息，Vk为量测噪声。
由于惯性导航的定位误差随时间积累，但是GNSS的RTK定位具有精度高，误差不随时间积累的特性。卡尔曼滤波不仅可以估计状态误差，还可以将传感器误差写入状态方程，本发明考虑卫星天线与惯导IMU中心臂杆误差的影响，利用卡尔曼滤波进行惯性/卫星组合，将惯导误差写入状态方程，以惯性导航技术计算得到的位置PINS和GNSS测量位置PGNSS之差作为观测量，可以很好的估计惯性器件的误差并实时的进行补偿，得到更精确的姿态角。
最后利用GNSS测量到的观测点定位信息PGNSS、修正后的姿态角和直杆长度计算测量点的位置，所述测量点的位置Pr计算方法为：
其中，为为观测点纬度，h为高度，M为子午圈曲率半径，N为卯酉圈曲率半径；PGNSS为GNSS测量到的观测点定位信息，为根据所述卡尔曼滤波估计得到的所述修正后的姿态角转换成的方向余弦阵，δl＝[0,0,-l]，l为观测点与测量点之间的直杆长度。
计算得到的测量点位置即为经过倾斜修正后的坐标值，处理器将修正后的坐标值输出，即完成了动态倾斜测量。
请参见图2，图2为图1所述系统中处理器的处理流程示意图；角速度和加速度传感器带宽为50Hz，PPS脉冲时钟频率为1Hz，GNSS板卡定位频率为 1Hz，处理器首先进行PPS脉冲时钟校准，根据角速度和加速度传感器测量值、 GNSS板卡定位信息结合惯性导航技术计算观测点的位置、姿态、速度并通过卡尔曼滤波进一步修正姿态角，然后根据GNSS定位信息、修正后的姿态角以及观测点和测量点之间的杆长实时计算并修正测量点位置，实现动态倾斜测量。
请参见图3，本发明在图1所述系统的基础上提出一种惯导技术辅助的高精度GNSS动态倾斜测量方法，所述方法包括：
S1、通过GNSS测量观测点定位信息，并进行PPS脉冲时钟校准；
S2、通过角速度传感器测量值、加速度传感器测量值计算观测点的位置、姿态、速度信息；所述步骤S2具体为：
S21、计算所述观测点的姿态信息
设获取到的观测点的初始定位信息为：初始位置向量信息：纬度经度λ，高度h；初始姿态角信息：航向角ψ，俯仰角θ，横滚角φ；初始速度：vn；根据所述初始姿态角信息得到初始姿态矩阵
其中Rx，Ry，Rz分别为绕x，y，z轴的单位旋转矩阵；
设角速度传感器测量值为加速度传感器测量值为和分别表示载体坐标系相对于惯性坐标系的角增量和速度增量，则载体坐标系相对于导航坐标系的角增量为：
其中，为的转置，为地球自转角速率在导航坐标系的投影，为载体运动引起的导航坐标系相对于地球旋转角速度，Δt＝tk+1-tk是时间间隔 (tk,tk+1)的增量，由此计算出旋转角增量表示的四元数更新方程：
其中，qk为tk时刻的四元数，qk+1为tk+1时刻的四元数； 令qk+1＝[q1,q2,q3,q4]T,将tk+1时刻的四元数qk+1转换为tk+1时刻的姿态矩阵然后将tk+1时刻的姿态矩阵转换成tk+1时刻的姿态角，获得tk+1时刻观测点的姿态信息，即航向角ψk+1，俯仰角θk+1，横滚角φk+1：
φk+1＝arctan2(c32,c33)
ψk+1＝arctan2(c21,c11)
其中cij代表姿态矩阵的第(i，j)个元素，i＝1,2,3,j＝1,2,3；
S22、计算观测点的速度信息
将加速度传感器测得的载体坐标系下的速度增量转换为导航坐标系下的速度增量
则经有害加速度改正后的速度增量为Δvn：
其中γn＝(0 0 γ)T，γ为在纬度和大地高度h下的重力；为地球自转角速率在导航系的投影，为载体运动引起的导航系相对于地球旋转角速度，Δt＝tk+1-tk，vn为初始速度向量信息；
已知所述观测点初始速度为vn，所述观测点的速度信息更新公式为：
其中为tk时刻的速度，为tk+1时刻的速度，为tk+1时刻速度增量；
S23、计算观测点的位置信息
已知初始的位置矢量为所述观测点的位置信息更新公式为：
其中为tk+1时刻的位置矢量，为tk时刻的位置矢量，M为子午圈曲率半径，N为卯酉圈曲率半径，分别为所述观测点在tk时刻、tk+1时刻的速度信息，Δt＝tk+1-tk。
S3、建立惯性导航与GNSS定位组合的状态方程，利用卡尔曼滤波估计角速度传感器、加速度传感器的误差并实时的进行误差补偿，得到修正后的姿态角信息；所述步骤S3中，所述状态方程为：
其中，误差状态向量X＝[φT (δvn)T (δp)T (εb)T (▽b)T]，Xk-1、Xk分别为tk-1时刻、tk时刻的误差状态向量；所述误差状态向量中，φ为姿态角误差矢量，δvn是速度误差矢量，δp是位置误差矢量，εb角速度传感器测量零漂，为加速度传感器测量零偏；F为tk-1时刻到tk时刻的状态转移矩阵，I为单位矩阵，Hk为 tk时刻的观测系数矩阵，Δt＝tk-tk-1；Zk为观测量，PINS为根据角速度传感器测量值、加速度传感器测量值计算得到观测点的位置，PGNSS为GNSS板卡测量到的观测点定位信息，Vk为量测噪声。
S4、根据所述观测点的定位信息、卡尔曼滤波估计得到的观测点修正后的姿态角信息、所述观测点和测量点之间的直杆长度计算出测量点的位置。
最后计算测量点的位置，所述测量点的位置Pr计算方法为：
其中， 为纬度，h为高度，M为子午圈曲率半径，N为卯酉圈曲率半径；PGNSS为GNSS测量到的观测点定位信息，为根据所述卡尔曼滤波估计得到的所述修正后的姿态角转换成的方向余弦阵，δl＝[0,0,-l]，l为观测点与测量点之间的直杆长度。
本发明以惯性导航技术和GNSS定位技术为基础，先通过GNSS定位技术获得观测点的定位信息，通过惯性导航技术获得观测点的速度、姿态(航向、俯仰、横滚)和位置等信息，利用卡尔曼滤波进行惯导/GNSS组合，得到精确的姿态信息，利用观测点的定位信息和姿态角信息计算出测量点位置信息，实现测量的倾斜改正。
在上述实施例中，对各个实施例的描述都各有侧重，某个实施例中没有详述或记载的部分，可以参见其它实施例的相关描述。说明书中其他为详述的部分均为为本领域公知常识。
以上所述，以上实施例仅用以说明本发明的技术方案，而非对其限制，尽管参照前述实施例对本发明进行了详细的说明，本领域的普通技术人员应当理解：其依然可以对前述各实施例所记载的技术方案进行修改，或者对其中部分技术特征进行等同替换；而这些修改或者替换，并不使相应技术方案的本质脱离本发明各实施例技术方案的精神和范围。

Claims (10)

1.一种惯导技术辅助的高精度GNSS动态倾斜测量系统，其特征在于，所述系统包括GNSS板卡和惯导模块，所述惯导模块包括处理器、以及分别与所述处理器通信连接的角速度传感器、加速度传感器、PPS脉冲时钟；
所述GNSS板卡用于测量观测点的定位信息，并将所述观测点的定位信息发送至所述惯导模块的处理器；
所述PPS脉冲时钟将所述角速度传感器、加速度传感和所述GNSS板卡的数据通过脉冲信号校准，实现数据时间上的同步；
所述处理器根据角速度传感器测量值、加速度传感器测量值计算得到观测点的位置、姿态、速度信息；建立惯性导航与GNSS定位组合的状态方程，利用卡尔曼滤波估计角速度传感器、加速度传感器的误差并实时的进行误差补偿，得到修正后的姿态角；根据所述观测点的定位信息、修正后的姿态角、所述观测点和测量点之间的直杆长度计算出测量点的位置。
2.根据权利要求1所述惯导技术辅助的高精度GNSS动态倾斜测量系统其特征在于，所述计算观测点的姿态信息具体包括：
设已知的初始位置向量信息：纬度经度λ，高度h；初始姿态角信息：航向角ψ，俯仰角θ，横滚角φ；初始速度：vn；根据所述初始姿态角信息得到初始姿态矩阵
其中Rx，Ry，Rz分别为绕x，y，z轴的单位旋转矩阵；
设角速度传感器测量值为加速度传感器测量值为和分别表示载体坐标系相对于惯性坐标系的角增量和速度增量，则载体坐标系相对于导航坐标系的角增量为：
其中，为的转置，为地球自转角速率在导航坐标系的投影，为载体运动引起的导航坐标系相对于地球旋转角速度，Δt＝tk+1-tk是时间间隔(tk,tk+1)的增量，k为正整数；由上述公式计算出角增量表示的四元数更新方程：
其中，qk为tk时刻的四元数，qk+1为tk+1时刻的四元数；
令qk+1＝[q1,q2,q3,q4]T,将tk+1时刻的四元数qk+1转换为tk+1时刻的姿态矩阵然后将tk+1时刻的姿态矩阵转换成tk+1时刻的姿态角，获得tk+1时刻观测点的姿态信息，即航向角ψk+1，俯仰角θk+1，横滚角φk+1：
φk+1＝arctan2(c32,c33)
ψk+1＝arctan2(c21,c11)
其中cij代表所述姿态矩阵的第(i,j)个元素，i＝1,2,3,j＝1,2,3。
3.根据权利要求2所述惯导技术辅助的高精度GNSS动态倾斜测量系统其特征在于，所述计算观测点的速度信息具体为：
将加速度传感器测得的载体坐标系下的速度增量转换为导航坐标系下的速度增量
则经有害加速度改正后的速度增量为Δvn：
其中γn＝(0 0 γ)T，γ为在纬度和大地高度h下的重力；为地球自转角速率在导航系的投影，为载体运动引起的导航系相对于地球旋转角速度，Δt＝tk+1-tk，vn为初始速度向量信息；
已知所述观测点初始速度为vn，所述观测点的速度信息更新公式为：：
其中为tk时刻的速度，为tk+1时刻的速度，为tk+1时刻速度增量。
4.根据权利要求3所述惯导技术辅助的高精度GNSS动态倾斜测量系统其特征在于，所述计算观测点的位置信息具体包括：
已知初始的位置矢量为所述观测点的位置信息更新公式为：
其中为tk+1时刻的位置矢量，为tk时刻的位置矢量，M为子午圈曲率半径，N为卯酉圈曲率半径，分别为所述观测点在tk时刻、tk+1时刻的速度信息，Δt＝tk+1-tk；根据所述观测点的位置信息更新公式得到观测点的位置信息PINS。
5.根据权利要求4所述惯导技术辅助的高精度GNSS动态倾斜测量系统其特征在于，所述惯性导航与GNSS定位组合的状态方程为：
其中，误差状态向量X＝[φT (δvn)T (δp)T (εb)T (▽b)T]，Xk-1、Xk分别为tk-1时刻、tk时刻的误差状态向量；所述误差状态向量中，φ为姿态角误差矢量，δvn是速度误差矢量，δp是位置误差矢量，εb角速度传感器测量零漂，▽b为加速度传感器测量零偏；F为tk-1时刻到tk时刻的状态转移矩阵，I为单位矩阵，Hk为tk时刻的观测系数矩阵，Δt＝tk-tk-1；Zk为观测量，PINS为根据角速度传感器测量值、加速度传感器测量值计算得到的观测点位置，PGNSS为GNSS板卡测量到的观测点定位信息，Vk为量测噪声。
6.根据权利要求5所述惯导技术辅助的高精度GNSS动态倾斜测量系统其特征在于，所述测量点的位置Pr计算方法为：
其中，为为纬度，h为高度，M为子午圈曲率半径，N为卯酉圈曲率半径；PGNSS为GNSS板卡测量到的观测点定位信息，为根据所述卡尔曼滤波估计得到的所述修正后的姿态角转换成的方向余弦阵，δl＝[0,0,-l]，l为观测点与测量点之间的直杆长度。
7.使用权利要求1所述系统的一种惯导技术辅助的高精度GNSS动态倾斜测量方法，其特征在于，所述方法包括：
S1、通过GNSS板卡测量观测点的定位信息，并进行PPS脉冲时钟校准；
S2、通过角速度传感器测量值、加速度传感器测量值计算观测点的位置、姿态、速度信息；
S3、建立惯性导航与GNSS定位组合的状态方程，利用卡尔曼滤波估计角速度传感器、加速度传感器的误差并实时的进行误差补偿，得到修正后的姿态角信息；
S4、根据所述观测点的定位信息、卡尔曼滤波估计得到的修正后的姿态角信息、所述观测点和测量点之间的直杆长度计算出测量点的位置。
8.根据权利要求7所述惯导技术辅助的高精度GNSS动态倾斜测量方法，其特征在于，所述步骤S2具体为：
S21、计算所述观测点的姿态信息
设获取到的观测点的初始定位信息为：初始位置向量信息：纬度经度λ，高度h；初始姿态角信息：航向角ψ，俯仰角θ，横滚角φ；初始速度：vn；根据所述初始姿态角信息得到初始姿态矩阵
其中Rx，Ry，Rz分别为绕x，y，z轴的单位旋转矩阵；
设角速度传感器测量值为加速度传感器测量值为和分别表示载体坐标系相对于惯性坐标系的角增量和速度增量，则载体坐标系相对于导航坐标系的角增量为：
其中，为的转置，为地球自转角速率在导航坐标系的投影，为载体运动引起的导航坐标系相对于地球旋转角速度，Δt＝tk+1-tk是时间间隔(tk,tk+1)的增量，由此计算出旋转角增量表示的四元数更新方程：
其中，qk为tk时刻的四元数，qk+1为tk+1时刻的四元数； 令qk+1＝[q1,q2,q3,q4]T,将tk+1时刻的四元数qk+1转换为tk+1时刻的姿态矩阵然后将tk+1时刻的姿态矩阵转换成tk+1时刻的姿态角，获得tk+1时刻观测点的姿态信息，即航向角ψk+1，俯仰角θk+1，横滚角φk+1：
φk+1＝arctan2(c32,c33)
ψk+1＝arctan2(c21,c11)
其中cij代表姿态矩阵的第(i，j)个元素，i＝1,2,3,j＝1,2,3；
S22、计算观测点的速度信息
将加速度传感器测得的载体坐标系下的速度增量转换为导航坐标系下的速度增量
则经有害加速度改正后的速度增量为Δvn：
其中γn＝(0 0 γ)T，γ为在纬度和大地高度h下的重力；为地球自转角速率在导航系的投影，为载体运动引起的导航系相对于地球旋转角速度，Δt＝tk+1-tk，vn为初始速度向量信息；
已知所述观测点初始速度为vn，所述观测点的速度信息更新公式为：
其中为tk时刻的速度，为tk+1时刻的速度，为tk+1时刻速度增量；
S23、计算观测点的位置信息
已知初始的位置矢量为所述观测点的位置信息更新公式为：
其中为tk+1时刻的位置矢量，为tk时刻的位置矢量，M为子午圈曲率半径，N为卯酉圈曲率半径，分别为所述观测点在tk时刻、tk+1时刻的速度信息，Δt＝tk+1-tk；根据所述观测点的位置信息更新公式获得观测点的位置信息PINS。
9.根据权利要求8所述惯导技术辅助的高精度GNSS动态倾斜测量方法，其特征在于，所述步骤S3中，所述状态方程为：
其中，误差状态向量X＝[φT (δvn)T (δp)T (εb)T (▽b)T]，Xk-1、Xk分别为tk-1时刻、tk时刻的误差状态向量；所述误差状态向量中，φ为姿态角误差矢量，δvn是速度误差矢量，δp是位置误差矢量，εb角速度传感器测量零漂，▽b为加速度传感器测量零偏；F为tk-1时刻到tk时刻的状态转移矩阵，I为单位矩阵，Hk为tk时刻的观测系数矩阵，Δt＝tk-tk-1；Zk为观测量，PINS为根据所述观测点的位置信息更新公式计算得到的观测点位置，PGNSS为GNSS板卡测量到的观测点定位信息，Vk为量测噪声。
10.根据权利要求9所述惯导技术辅助的高精度GNSS动态倾斜测量系统其特征在于，所述测量点的位置Pr计算方法为：
其中， 为纬度，h为高度，M为子午圈曲率半径，N为卯酉圈曲率半径；PGNSS为GNSS测量到的观测点定位信息，为根据所述修正后的姿态角转换成的方向余弦阵，δl＝[0,0,-l]，l为观测点与测量点之间的直杆长度。
CN201910311556.5A 2019-04-18 2019-04-18 惯导技术辅助的高精度gnss动态倾斜测量系统及方法 Active CN110133692B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910311556.5A CN110133692B (zh) 2019-04-18 2019-04-18 惯导技术辅助的高精度gnss动态倾斜测量系统及方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910311556.5A CN110133692B (zh) 2019-04-18 2019-04-18 惯导技术辅助的高精度gnss动态倾斜测量系统及方法

Publications (2)

Publication Number Publication Date
CN110133692A true CN110133692A (zh) 2019-08-16
CN110133692B CN110133692B (zh) 2023-01-31

Family

ID=67570186

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910311556.5A Active CN110133692B (zh) 2019-04-18 2019-04-18 惯导技术辅助的高精度gnss动态倾斜测量系统及方法

Country Status (1)

Country Link
CN (1) CN110133692B (zh)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111795695A (zh) * 2020-05-15 2020-10-20 北京百度网讯科技有限公司 位置信息确定方法、装置及设备
CN113514865A (zh) * 2020-12-31 2021-10-19 上海司南卫星导航技术股份有限公司 一种组合导航装置的初始化方法、组合导航装置及计算机可读介质
CN114199115A (zh) * 2020-09-18 2022-03-18 千寻位置网络有限公司 对中杆杆长校准方法、rtk接收机系统倾斜测量方法及系统
CN114383613A (zh) * 2022-01-18 2022-04-22 广东工业大学 一种基于北斗定向的电力线舞动监测系统和方法
CN115435817A (zh) * 2022-11-07 2022-12-06 开拓导航控制技术股份有限公司 Mems惯导安装误差的标定方法、存储介质和控制计算机

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20030149528A1 (en) * 2002-02-06 2003-08-07 Ching-Fang Lin Positioning and navigation method and system thereof
CN106908060A (zh) * 2017-02-15 2017-06-30 东南大学 一种基于mems惯性传感器的高精度室内定位方法
CN108180925A (zh) * 2017-12-15 2018-06-19 中国船舶重工集团公司第七0七研究所 一种里程计辅助车载动态对准方法

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20030149528A1 (en) * 2002-02-06 2003-08-07 Ching-Fang Lin Positioning and navigation method and system thereof
CN106908060A (zh) * 2017-02-15 2017-06-30 东南大学 一种基于mems惯性传感器的高精度室内定位方法
CN108180925A (zh) * 2017-12-15 2018-06-19 中国船舶重工集团公司第七0七研究所 一种里程计辅助车载动态对准方法

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111795695A (zh) * 2020-05-15 2020-10-20 北京百度网讯科技有限公司 位置信息确定方法、装置及设备
CN111795695B (zh) * 2020-05-15 2022-06-03 阿波罗智联(北京)科技有限公司 位置信息确定方法、装置及设备
CN114199115A (zh) * 2020-09-18 2022-03-18 千寻位置网络有限公司 对中杆杆长校准方法、rtk接收机系统倾斜测量方法及系统
CN114199115B (zh) * 2020-09-18 2024-04-02 千寻位置网络有限公司 对中杆杆长校准方法、rtk接收机系统倾斜测量方法及系统
CN113514865A (zh) * 2020-12-31 2021-10-19 上海司南卫星导航技术股份有限公司 一种组合导航装置的初始化方法、组合导航装置及计算机可读介质
CN114383613A (zh) * 2022-01-18 2022-04-22 广东工业大学 一种基于北斗定向的电力线舞动监测系统和方法
CN114383613B (zh) * 2022-01-18 2023-12-15 广东工业大学 一种基于北斗定向的电力线舞动监测系统和方法
CN115435817A (zh) * 2022-11-07 2022-12-06 开拓导航控制技术股份有限公司 Mems惯导安装误差的标定方法、存储介质和控制计算机
CN115435817B (zh) * 2022-11-07 2023-03-14 开拓导航控制技术股份有限公司 Mems惯导安装误差的标定方法、存储介质和控制计算机

Also Published As

Publication number Publication date
CN110133692B (zh) 2023-01-31

Similar Documents

Publication Publication Date Title
US11409001B2 (en) Method for tilt measurement and compensation of surveying instrument based on GNSS receiver and IMU sensor
CN110133692A (zh) 惯导技术辅助的高精度gnss动态倾斜测量系统及方法
CN105180968B (zh) 一种imu/磁强计安装失准角在线滤波标定方法
CN109269471B (zh) 一种新型gnss接收机倾斜测量系统及方法
US6860023B2 (en) Methods and apparatus for automatic magnetic compensation
CN105043415B (zh) 基于四元数模型的惯性系自对准方法
US11598886B2 (en) GNSS/IMU surveying and mapping system and method
US5883817A (en) Method and apparatus for precise positioning of large structures
CN104698486B (zh) 一种分布式pos用数据处理计算机系统实时导航方法
CN110926468B (zh) 基于传递对准的动中通天线多平台航姿确定方法
CN106500693B (zh) 一种基于自适应扩展卡尔曼滤波的ahrs算法
CN106767787A (zh) 一种紧耦合gnss/ins组合导航装置
CN110501024A (zh) 一种车载ins/激光雷达组合导航系统的量测误差补偿方法
CN109916395A (zh) 一种姿态自主冗余组合导航算法
CN110221332A (zh) 一种车载gnss/ins组合导航的动态杆臂误差估计和补偿方法
CN110095800A (zh) 一种多源融合的自适应容错联邦滤波组合导航方法
CN107687114B (zh) 一种轨道绝对位置与偏差测量方法
CN107270893A (zh) 面向不动产测量的杆臂、时间不同步误差估计与补偿方法
CN109916394A (zh) 一种融合光流位置和速度信息的组合导航算法
CN104049269B (zh) 一种基于激光测距和mems/gps组合导航系统的目标导航测绘方法
CN105928515B (zh) 一种无人机导航系统
CN101162147A (zh) 大失准角下船用光纤陀螺捷联航姿系统系泊精对准方法
CN110044378A (zh) 一种用于水下深潜器的光纤捷联惯性导航高精度定位系统及方法
CN107677292B (zh) 基于重力场模型的垂线偏差补偿方法
CN101769742A (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
CB02 Change of applicant information

Address after: Room 1401, Building A1, Phase II Airspace, Wuhan University Science Park, Donghu New Technology Development Zone, Wuhan City, Hubei Province, 430014

Applicant after: Wuhan tianqiongrong New Technology Co.,Ltd.

Address before: Room 1401, Building A1, Phase II Airspace, Wuhan University Science Park, Donghu New Technology Development Zone, Wuhan City, Hubei Province, 430014

Applicant before: WUHAN CANGQIONG ELECTRONIC INSTRUMENT CO.,LTD.

CB02 Change of applicant information
GR01 Patent grant
GR01 Patent grant