CN105823481A - 一种基于单天线的gnss-ins车辆定姿方法 - Google Patents
一种基于单天线的gnss-ins车辆定姿方法 Download PDFInfo
- Publication number
- CN105823481A CN105823481A CN201510969458.2A CN201510969458A CN105823481A CN 105823481 A CN105823481 A CN 105823481A CN 201510969458 A CN201510969458 A CN 201510969458A CN 105823481 A CN105823481 A CN 105823481A
- Authority
- CN
- China
- Prior art keywords
- vehicle
- angle
- gnss
- gyroscope
- accelerometer
- 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
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
- G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
- G01B21/00—Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant
- G01B21/22—Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant for measuring angles or tapers; for testing the alignment of axes
-
- 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/18—Stabilised platforms, e.g. by gyroscope
-
- 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
- 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
-
- 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/52—Determining velocity
-
- 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/53—Determining 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
- 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
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)
- Navigation (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
- Gyroscopes (AREA)
Abstract
本发明公开了一种基于单天线的GNSS‑INS车辆定姿方法,包括以下步骤:将GNSS天线固定安装于车辆中心质心位置,同时将MEMS传感器的IMU测量单元固定安装于车辆的转向车轴上;通过GNSS天线获取车辆位置和速度信息,通过IMU测量单元获取车辆的航向角速率信息;通过加速度计和陀螺仪融合的方法进行车辆姿态角解算;根据车辆位置、速度和航向角速率信息进行车辆航向角解算。采用单天线GNSS与低成本IMU/MEMS传感器组组合,基于农用车辆的运动学模型进行定姿、定向,具有短期精度高、长期稳定性高的优点,避免了使用陀螺仪时的发散现象,同时降低GNSS测姿的噪声水平,测姿精度可提高数倍。
Description
技术领域
本发明涉及农业车辆自动化领域,尤其涉及一种基于单天线的GNSS-INS车辆定姿方法。
背景技术
随着以生物技术、GNSS技术、信息技术为先导的现在科学技术发展及其在农业上的广泛应用,精准农业应用而生,而农机自动驾驶系统作为其核心载体,其在耕地、播种、施肥、灌溉、植保和收获等各种农艺作业中,将有着十分重要的意义。
为提高农业车辆自动驾驶系统的精度,需要测量农业车辆位置坐标、航向角以及姿态角等导航精度,且测量值应尽量准确。特别是当装备了GNSS接收机的农用车辆在田间行走时,由于轮胎在土壤里受力不均,车体发生颠簸导致GNSS接收天线的位置倾斜,其结果是GNSS天线与车体质心不重合,因此需要精确已知车体的姿态角和航向角。
目前常采用多天线GNSS测姿的方法,但是该方法具有成本高、天线接收延迟、实时性差、安装难度大等缺点;而陆地导航系统的中常用惯性导航INS进行定姿,也由于其成本高等原因不适用于农用车辆的定姿定向。
发明内容
鉴于目前农业车辆自动化领域存在的上述不足,本发明提供一种基于单天线的GNSS-INS车辆定姿方法,能够通过单天线实现对车辆定姿定向,提高了定姿精度。
为达到上述目的,本发明的实施例采用如下技术方案:
一种基于单天线的GNSS-INS车辆定姿方法,所述基于单天线的GNSS-INS车辆定姿方法包括以下步骤:
将GNSS天线固定安装于车辆中心质心位置,同时将MEMS传感器的IMU测量单元固定安装于车辆的转向车轴上;
通过GNSS天线获取车辆位置和速度信息,通过IMU测量单元获取车辆的航向角速率信息;
通过加速度计和陀螺仪融合的方法进行车辆姿态角解算;
根据车辆位置、速度和航向角速率信息进行车辆航向角解算。
依照本发明的一个方面,所述将MEMS传感器的IMU测量单元固定安装于车辆的转向车轴上时,需保证IMU测量单元的三轴坐标系与机车三轴坐标系一致。
依照本发明的一个方面,所述通过加速度计和陀螺仪融合的方法进行车辆姿态角解算包括:
当车辆处于静止或者匀速运动的情况下时,其加速度值为零,根据加速度计的原理,可准确得到车辆的横滚角和俯仰角:
θ=sin-1(ax)
式中,ax、ay为载体坐标系的x轴和y轴的加速度;θ为俯仰角;φ为横滚角;
当车辆运动或者抖动比较大时,引入陀螺仪,采用加速度计和陀螺仪融合的方法进行,具体如下:
首先构建横滚角和俯仰角组合滤波器,具体滤波器如下:
其中待估参数如下:
x(t)=[θφωxωyωz]T;
观测向量如下:
z(t)=[bfx bfy bωibx bωiby bωibz]T,其中bfx,y和bωibx,y,z为加速计和陀螺仪输出值;
状态转移矩阵如下:
观测设计矩阵如下:
f(x(t))=[sinθcosφωxωyωz]T
根据上述参数计算得到车辆的横滚角和俯仰角。
依照本发明的一个方面,所述通过加速度计和陀螺仪融合的方法进行车辆姿态角解算包括:
当车辆处于静止或者匀速运动的情况下时,其加速度值为零,根据加速度计的原理,可准确得到车辆的横滚角和俯仰角:
θ=sin-1(ax)
式中,ax、ay为载体坐标系的x轴和y轴的加速度;θ为俯仰角;φ为横滚角;
当车辆运动或者抖动比较大时,引入陀螺仪,采用加速度计和陀螺仪融合的方法进行,具体如下:
由于倾角(横滚角或者俯仰角)和倾角角速度存在导数关系,因此可将系统倾斜真实角度可用来做一个状态向量,采用加速度计估计出陀螺仪常值偏差b,以此偏差作为状态向量得到相应的状态方程和观测方程:
式中,ωgyro为包含固定偏差的陀螺仪输出角速度,为加速度计经处理后得到的角度值,wg为陀螺仪测量噪声,wa为加速度计测量噪声,b为陀螺仪漂移误差,wg与wa相互独立,并假设二者为满足正态分布的白色噪声。同时设定卡尔曼滤波器的系统过程噪声协方差阵Q以及测量误差的协方差矩阵R,其形式如下:
R=[r_acce]
式中,q_acce和q_gyro分别是加速度计和陀螺仪测量的协方差,r_acce为加速度计测量噪声;
根据上述参数计算得到车辆的横滚角和俯仰角。
依照本发明的一个方面,所述根据车辆位置、速度和航向角速率信息进行车辆航向角解算包括:
航向角可由东、北向速度计算得到,即:
ψp=arctan(vE/vN)
式中,ψp为GNSS航向角,vE、vN为东北向速度;
当车辆静止或者速度非常小时,引入z轴陀螺仪和GNSS进行组合来进行航向角的高精度解算,系统方程和观测方程如下:
式中,ψGNSS为GNSS输出的航向角,br为陀螺仪漂移误差,whd为航向过程噪声,Tb为一阶马尔科夫相关时间。
线性化之后如下:
当车辆运动时,Hyaw=[10],其它情况下Hyaw=[00]。
依照本发明的一个方面,所述MEMS传感器为六轴MEMS传感器。
本发明实施的优点:本发明所述的基于单天线的GNSS-INS车辆定姿方法,包括以下步骤:将GNSS天线固定安装于车辆中心质心位置,同时将MEMS传感器的IMU测量单元固定安装于车辆的转向车轴上;通过GNSS天线获取车辆位置和速度信息,通过IMU测量单元获取车辆的航向角速率信息;通过加速度计和陀螺仪融合的方法进行车辆姿态角解算;根据车辆位置、速度和航向角速率信息进行车辆航向角解算。采用单天线GNSS与低成本IMU/MEMS传感器组组合,基于农用车辆的运动学模型进行定姿、定向,该方法吸收了IMU陀螺仪短期精度高和GNSS单天线测姿长期稳定性高的优点,避免了使用陀螺仪时的发散现象,同时降低GNSS测姿的噪声水平,测姿精度可提高数倍。
下面将对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
具体实施方式
实施例一
一种基于单天线的GNSS-INS车辆定姿方法,所述基于单天线的GNSS-INS车辆定姿方法包括以下步骤:
步骤S1:将GNSS天线固定安装于车辆中心质心位置,同时将MEMS传感器的IMU测量单元固定安装于车辆的转向车轴上;
所述步骤S1将GNSS天线固定安装于车辆中心质心位置,同时将MEMS传感器的IMU测量单元固定安装于车辆的转向车轴上的具体实施方式可为:将GNSS天线固定安装于机车中心质心位置,以精确测量出载体机车的位置和速度,传感器MEMS-IMU测量单元固定安装于载体机车上时需保证IMU的三轴坐标系与机车三轴坐标系一致;同时IMU测量单元需随机车车轮转向而实时转向,即将IMU单元固装于车轴以便IMU能精确敏感机车的航向角速率,使IMU敏感航向信息与GNSS测量的航向信息一致。
步骤S2:通过GNSS天线获取车辆位置和速度信息,通过IMU测量单元获取车辆的航向角速率信息;
所述步骤S2通过GNSS天线获取车辆位置和速度信息,通过IMU测量单元获取车辆的航向角速率信息,采用了3+3六轴集成MEMS-IMU传感器,能精确获得车辆的航向角速率信息。
步骤S3:通过加速度计和陀螺仪融合的方法进行车辆姿态角解算;
所述步骤S3通过加速度计和陀螺仪融合的方法进行车辆姿态角解算具体可包括:
因MEMS-IMU的陀螺测量精度无法敏感地球自转角速率,故MEMS系统无法进行全自主对准;当车辆处于静止或者匀速运动的情况下时,其加速度值为零,根据加速度计的原理,可准确得到车辆的横滚角和俯仰角:
θ=sin-1(ax)
式中,ax、ay为载体坐标系的x轴和y轴的加速度;θ为俯仰角;φ为横滚角;
当车辆运动或者抖动比较大时,由于其它方向的加速度的影响,采用上式不能准确计算出姿态角,为此引入陀螺仪,采用加速度计和陀螺仪融合的方法进行解算,具体如下:
首先构建横滚角和俯仰角组合滤波器,具体滤波器如下:
其中待估参数如下:
x(t)=[θφωxωyωz]T;
观测向量如下:
z(t)=[bfx bfy bωibx bωiby bωibz]T,其中bfx,y和bωibx,y,z为加速计和陀螺仪输出值;
状态转移矩阵如下:
观测设计矩阵如下:
f(x(t))=[sinθcosφωxωyωz]T
根据上述参数计算得到车辆的横滚角和俯仰角,从而解算出了车辆的姿态角。
步骤S4:根据车辆位置、速度和航向角速率信息进行车辆航向角解算。
所述步骤S4根据车辆位置、速度和航向角速率信息进行车辆航向角解算的具体实施方式可为:
单天线GNSS测姿主要利用GNSS速度,其航向角可由东、北向速度计算得到,即:
ψp=arctan(vE/vN)
式中,ψp为GNSS航向角,vE、vN为东北向速度;
在实际应用中,GNSS航向角可直接从GNSS接收机输出的NMEA语句中提取,但是当车辆静止或者速度非常小时,数学上造成数值不稳定性,而且速度测量误差可能会淹没真实速度值。
为提高其航向精度,引入z轴陀螺仪和GNSS进行组合,陀螺仪沿载体坐标系z轴向上安装。系统方程和观测方程如下:
式中,ψGNSS为GNSS输出的航向角,br为陀螺仪漂移误差,whd为航向过程噪声,Tb为一阶马尔科夫相关时间。
线性化之后如下:
当车辆运动时,Hyaw=[10],其它情况下Hyaw=[00]。
通过上述的车辆姿态角解算及航向角解算,最终实现了基于单天线的GNSS-INS车辆的定姿。
本发明所述的基于单天线的GNSS-INS车辆定姿方法,包括以下步骤:将GNSS天线固定安装于车辆中心质心位置,同时将MEMS传感器的IMU测量单元固定安装于车辆的转向车轴上;通过GNSS天线获取车辆位置和速度信息,通过IMU测量单元获取车辆的航向角速率信息;通过加速度计和陀螺仪融合的方法进行车辆姿态角解算;根据车辆位置、速度和航向角速率信息进行车辆航向角解算。采用单天线GNSS与低成本IMU/MEMS传感器组组合,基于农用车辆的运动学模型进行定姿、定向,该方法吸收了IMU陀螺仪短期精度高和GNSS单天线测姿长期稳定性高的优点,避免了使用陀螺仪时的发散现象,同时降低GNSS测姿的噪声水平,测姿精度可提高数倍。本实施例所述的测姿方法结合IMU传感器,经测试其航向角误差小于0.2°,俯仰角和横滚角误差小于0.08°。在实际应用中,采用了3+3六轴集成IMU传感器,体积小,重量轻,性价比高,模块化设计便于集成到农业机械辅助驾驶控制系统之中。
在实际应用中,还可使用倾角传感器代替IMU传感器实现该定姿方案。
实施例二
一种基于单天线的GNSS-INS车辆定姿方法,所述基于单天线的GNSS-INS车辆定姿方法包括以下步骤:
步骤S1:将GNSS天线固定安装于车辆中心质心位置,同时将MEMS传感器的IMU测量单元固定安装于车辆的转向车轴上;
所述步骤S1将GNSS天线固定安装于车辆中心质心位置,同时将MEMS传感器的IMU测量单元固定安装于车辆的转向车轴上的具体实施方式可为:将GNSS天线固定安装于机车中心质心位置,以精确测量出载体机车的位置和速度,传感器MEMS-IMU测量单元固定安装于载体机车上时需保证IMU的三轴坐标系与机车三轴坐标系一致;同时IMU测量单元需随机车车轮转向而实时转向,即将IMU单元固装于车轴以便IMU能精确敏感机车的航向角速率,使IMU敏感航向信息与GNSS测量的航向信息一致。
步骤S2:通过GNSS天线获取车辆位置和速度信息,通过IMU测量单元获取车辆的航向角速率信息;
所述步骤S2通过GNSS天线获取车辆位置和速度信息,通过IMU测量单元获取车辆的航向角速率信息,采用了3+3六轴集成MEMS-IMU传感器,能精确获得车辆的航向角速率信息。
步骤S3:通过加速度计和陀螺仪融合的方法进行车辆姿态角解算;
所述步骤S3通过加速度计和陀螺仪融合的方法进行车辆姿态角解算具体可包括:
因MEMS-IMU的陀螺测量精度无法敏感地球自转角速率,故MEMS系统无法进行全自主对准;当车辆处于静止或者匀速运动的情况下时,其加速度值为零,根据加速度计的原理,可准确得到车辆的横滚角和俯仰角:
θ=sin-1(ax)
式中,ax、ay为载体坐标系的x轴和y轴的加速度;θ为俯仰角;φ为横滚角;
当车辆运动或者抖动比较大时,由于其它方向的加速度的影响,采用上式不能准确计算出姿态角,为此引入陀螺仪,采用加速度计和陀螺仪融合的方法进行解算,具体如下:
由于倾角(横滚角或者俯仰角)和倾角角速度存在导数关系,因此可将系统倾斜真实角度可用来做一个状态向量,采用加速度计估计出陀螺仪常值偏差b,以此偏差作为状态向量得到相应的状态方程和观测方程:
式中,ωgyro为包含固定偏差的陀螺仪输出角速度,为加速度计经处理后得到的角度值,wg为陀螺仪测量噪声,wa为加速度计测量噪声,b为陀螺仪漂移误差,wg与wa相互独立,并假设二者为满足正态分布的白色噪声。同时设定卡尔曼滤波器的系统过程噪声协方差阵Q以及测量误差的协方差矩阵R,其形式如下:
R=[r_acce]
式中,q_acce和q_gyro分别是加速度计和陀螺仪测量的协方差,r_acce为加速度计测量噪声;
根据上述参数计算得到车辆的横滚角和俯仰角,从而解算出了车辆的姿态角。
步骤S4:根据车辆位置、速度和航向角速率信息进行车辆航向角解算。
所述步骤S4根据车辆位置、速度和航向角速率信息进行车辆航向角解算的具体实施方式可为:
单天线GNSS测姿主要利用GNSS速度,其航向角可由东、北向速度计算得到,即:
ψp=arctan(vE/vN)
式中,ψp为GNSS航向角,vE、vN为东北向速度;
在实际应用中,GNSS航向角可直接从GNSS接收机输出的NMEA语句中提取,但是当车辆静止或者速度非常小时,数学上造成数值不稳定性,而且速度测量误差可能会淹没真实速度值。
为提高其航向精度,引入z轴陀螺仪和GNSS进行组合,陀螺仪沿载体坐标系z轴向上安装。系统方程和观测方程如下:
式中,ψGNSS为GNSS输出的航向角,br为陀螺仪漂移误差,whd为航向过程噪声,Tb为一阶马尔科夫相关时间。
线性化之后如下:
当车辆运动时,Hyaw=[10],其它情况下Hyaw=[00]。
通过上述的车辆姿态角解算及航向角解算,最终实现了基于单天线的GNSS-INS车辆的定姿。
包括以下步骤:将GNSS天线固定安装于车辆中心质心位置,同时将MEMS传感器的IMU测量单元固定安装于车辆的转向车轴上;通过GNSS天线获取车辆位置和速度信息,通过IMU测量单元获取车辆的航向角速率信息;通过加速度计和陀螺仪融合的方法进行车辆姿态角解算;根据车辆位置、速度和航向角速率信息进行车辆航向角解算。采用单天线GNSS与低成本IMU/MEMS传感器组组合,基于农用车辆的运动学模型进行定姿、定向,该方法吸收了IMU陀螺仪短期精度高和GNSS单天线测姿长期稳定性高的优点,避免了使用陀螺仪时的发散现象,同时降低GNSS测姿的噪声水平,测姿精度可提高数倍。本实施例所述的测姿方法结合IMU传感器,经测试其航向角误差小于0.2°,俯仰角和横滚角误差小于0.08°。在实际应用中,采用了3+3六轴集成IMU传感器,体积小,重量轻,性价比高,模块化设计便于集成到农业机械辅助驾驶控制系统之中。
在实际应用中,还可使用倾角传感器代替IMU传感器实现该定姿方案。
本发明实施的优点:本发明所述的基于单天线的GNSS-INS车辆定姿方法包括以下步骤:将GNSS天线固定安装于车辆中心质心位置,同时将MEMS传感器的IMU测量单元固定安装于车辆的转向车轴上;通过GNSS天线获取车辆位置和速度信息,通过IMU测量单元获取车辆的航向角速率信息;通过加速度计和陀螺仪融合的方法进行车辆姿态角解算;根据车辆位置、速度和航向角速率信息进行车辆航向角解算。采用单天线GNSS与低成本IMU/MEMS传感器组组合,基于农用车辆的运动学模型进行定姿、定向,该方法吸收了IMU陀螺仪短期精度高和GNSS单天线测姿长期稳定性高的优点,避免了使用陀螺仪时的发散现象,同时降低GNSS测姿的噪声水平,测姿精度可提高数倍。本发明所述的定姿方法结合IMU传感器,经测试其航向角误差小于0.2°,俯仰角和横滚角误差小于0.08°。采用了3+3六轴集成IMU传感器,体积小,重量轻,性价比高,模块化设计便于集成到农业机械辅助驾驶控制系统之中。
以上所述,仅为本发明的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本领域技术的技术人员在本发明公开的技术范围内,可轻易想到的变化或替换,都应涵盖在本发明的保护范围之内。因此,本发明的保护范围应以所述权利要求的保护范围为准。
Claims (6)
1.一种基于单天线的GNSS-INS车辆定姿方法,其特征在于,所述基于单天线的GNSS-INS车辆定姿方法包括以下步骤:
将GNSS天线固定安装于车辆中心质心位置,同时将MEMS传感器的IMU测量单元固定安装于车辆的转向车轴上;
通过GNSS天线获取车辆位置和速度信息,通过IMU测量单元获取车辆的航向角速率信息;
通过加速度计和陀螺仪融合的方法进行车辆姿态角解算;
根据车辆位置、速度和航向角速率信息进行车辆航向角解算。
2.根据权利要求1所述的基于单天线的GNSS-INS车辆定姿方法,其特征在于,所述将MEMS传感器的IMU测量单元固定安装于车辆的转向车轴上时,需保证IMU测量单元的三轴坐标系与机车三轴坐标系一致。
3.根据权利要求1所述的基于单天线的GNSS-INS车辆定姿方法,其特征在于,所述通过加速度计和陀螺仪融合的方法进行车辆姿态角解算包括:
当车辆处于静止或者匀速运动的情况下时,其加速度值为零,根据加速度计的原理,可准确得到车辆的横滚角和俯仰角:
θ=sin-1(ax)
式中,ax、ay为载体坐标系的x轴和y轴的加速度;θ为俯仰角;φ为横滚角;
当车辆运动或者抖动比较大时,引入陀螺仪,采用加速度计和陀螺仪融合的方法进行,具体如下:
首先构建横滚角和俯仰角组合滤波器,具体滤波器如下:
其中待估参数如下:
x(t)=[θφωxωyωz]T;
观测向量如下:
z(t)=[bfx bfy bωibx bωiby bωibz]T,其中bfx,y和bωibx,y,z为加速计和陀螺仪输出值;
状态转移矩阵如下:
观测设计矩阵如下:
f(x(t))=[sinθcosφωxωyωz]T
根据上述参数计算得到车辆的横滚角和俯仰角。
4.根据权利要求1所述的基于单天线的GNSS-INS车辆定姿方法,其特征在于,所述通过加速度计和陀螺仪融合的方法进行车辆姿态角解算包括:
当车辆处于静止或者匀速运动的情况下时,其加速度值为零,根据加速度计的原理,可准确得到车辆的横滚角和俯仰角:
θ=sin-1(ax)
式中,ax、ay为载体坐标系的x轴和y轴的加速度;θ为俯仰角;φ为横滚角;
当车辆运动或者抖动比较大时,引入陀螺仪,采用加速度计和陀螺仪融合的方法进行,具体如下:
由于倾角(横滚角或者俯仰角)和倾角角速度存在导数关系,因此可将系统倾斜真实角度可用来做一个状态向量,采用加速度计估计出陀螺仪常值偏差b,以此偏差作为状态向量得到相应的状态方程和观测方程:
式中,ωgyro为包含固定偏差的陀螺仪输出角速度,为加速度计经处理后得到的角度值,wg为陀螺仪测量噪声,wa为加速度计测量噪声,b为陀螺仪漂移误差,wg与wa相互独立,并假设二者为满足正态分布的白色噪声。同时设定卡尔曼滤波器的系统过程噪声协方差阵Q以及测量误差的协方差矩阵R,其形式如下:
式中,q_acce和q_gyro分别是加速度计和陀螺仪测量的协方差,r_acce为加速度计测量噪声;
根据上述参数计算得到车辆的横滚角和俯仰角。
5.根据权利要求1至4之一所述的基于单天线的GNSS-INS车辆定姿方法,其特征在于,所述根据车辆位置、速度和航向角速率信息进行车辆航向角解算包括:
航向角可由东、北向速度计算得到,即:
ψp=arctan(vE/vN)
式中,ψp为GNSS航向角,vE、vN为东北向速度;
当车辆静止或者速度非常小时,引入z轴陀螺仪和GNSS进行组合来进行航向角的高精度解算,系统方程和观测方程如下:
式中,ψGNSS为GNSS输出的航向角,br为陀螺仪漂移误差,whd为航向过程噪声,Tb为一阶马尔科夫相关时间。
线性化之后如下:
当车辆运动时,Hyaw=[10],其它情况下Hyaw=[00]。
6.根据权利要求5所述的基于单天线的GNSS-INS车辆定姿方法,其特征在于,所述MEMS传感器为六轴MEMS传感器。
Priority Applications (8)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510969458.2A CN105823481B (zh) | 2015-12-21 | 2015-12-21 | 一种基于单天线的gnss-ins车辆定姿方法 |
EP16877247.3A EP3396316B1 (en) | 2015-12-21 | 2016-07-04 | Gnss-ins vehicle attitude determination method based on single antenna |
US15/547,062 US10605605B2 (en) | 2015-12-21 | 2016-07-04 | Method of determining GNSS-INS vehicle attitude based on single antenna |
ES16877247T ES2826887T3 (es) | 2015-12-21 | 2016-07-04 | Método de determinación de la actitud de vehículos con GNSS-INS basándose en una única antena |
RU2017125951A RU2662462C1 (ru) | 2015-12-21 | 2016-07-04 | Способ определения пространственного положения транспортного средства на базе gnss-ins с использованием одиночной антенны |
PCT/CN2016/088345 WO2017107434A1 (zh) | 2015-12-21 | 2016-07-04 | 一种基于单天线的gnss-ins车辆定姿方法 |
KR1020177024309A KR102018450B1 (ko) | 2015-12-21 | 2016-07-04 | 단일 안테나에 기초한 gnss―ins 차량 자세 결정 방법 |
PL16877247T PL3396316T3 (pl) | 2015-12-21 | 2016-07-04 | Sposób określania położenia pojazdu gnss-ins w oparciu o pojedynczą antenę |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510969458.2A CN105823481B (zh) | 2015-12-21 | 2015-12-21 | 一种基于单天线的gnss-ins车辆定姿方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105823481A true CN105823481A (zh) | 2016-08-03 |
CN105823481B CN105823481B (zh) | 2019-02-12 |
Family
ID=56514660
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510969458.2A Active CN105823481B (zh) | 2015-12-21 | 2015-12-21 | 一种基于单天线的gnss-ins车辆定姿方法 |
Country Status (8)
Country | Link |
---|---|
US (1) | US10605605B2 (zh) |
EP (1) | EP3396316B1 (zh) |
KR (1) | KR102018450B1 (zh) |
CN (1) | CN105823481B (zh) |
ES (1) | ES2826887T3 (zh) |
PL (1) | PL3396316T3 (zh) |
RU (1) | RU2662462C1 (zh) |
WO (1) | WO2017107434A1 (zh) |
Cited By (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106595656A (zh) * | 2016-12-29 | 2017-04-26 | 辽宁工程技术大学 | 一种基于车载pos的公路线形特征识别与参数计算方法 |
CN107063241A (zh) * | 2017-03-16 | 2017-08-18 | 上海联适导航技术有限公司 | 基于双gnss天线及单轴mems陀螺的前轮测角系统 |
CN108052106A (zh) * | 2018-01-19 | 2018-05-18 | 东南大学 | 一种基于ros的无人驾驶农机路径跟踪系统 |
CN108663036A (zh) * | 2018-04-04 | 2018-10-16 | 南京天辰礼达电子科技有限公司 | 一种车辆前轮转动跟踪系统及算法 |
CN109443349A (zh) * | 2018-11-14 | 2019-03-08 | 广州中海达定位技术有限公司 | 一种姿态航向测量系统及其融合方法、存储介质 |
CN109917440A (zh) * | 2019-04-09 | 2019-06-21 | 广州小鹏汽车科技有限公司 | 一种组合导航方法、系统及车辆 |
CN110426011A (zh) * | 2018-04-28 | 2019-11-08 | 西安合众思壮导航技术有限公司 | 车辆转向角测量系统及方法 |
CN111912426A (zh) * | 2020-08-10 | 2020-11-10 | 电子科技大学 | 一种基于mems imu的低成本里程计设计方法 |
CN112326990A (zh) * | 2020-10-22 | 2021-02-05 | 北京农业智能装备技术研究中心 | 一种作业车辆测速方法及系统 |
WO2021068650A1 (zh) * | 2019-10-07 | 2021-04-15 | 佛吉亚歌乐电子(丰城)有限公司 | 基于gps惯性导航的车载指南针实现方法及系统 |
CN113391336A (zh) * | 2021-06-17 | 2021-09-14 | 上海联适导航技术股份有限公司 | 一种航向角的检测方法、装置、设备及可读存储介质 |
CN113534220A (zh) * | 2021-07-27 | 2021-10-22 | 联创汽车电子有限公司 | 车辆航向角计算方法、存储介质、计算单元和系统 |
CN113720336A (zh) * | 2021-08-10 | 2021-11-30 | 广东汇天航空航天科技有限公司 | 一种航向信息确定方法、车辆以及计算机可读存储介质 |
CN114674271A (zh) * | 2022-02-11 | 2022-06-28 | 江苏大学 | 单天线gnss辅助陀螺仪的农机转向角测量方法及装置 |
CN115542363A (zh) * | 2022-11-24 | 2022-12-30 | 浙江航天润博测控技术有限公司 | 一种适用于垂直下视航空吊舱的姿态测量方法 |
CN114674271B (zh) * | 2022-02-11 | 2024-06-07 | 江苏大学 | 单天线gnss辅助陀螺仪的农机转向角测量方法及装置 |
Families Citing this family (21)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105823481B (zh) * | 2015-12-21 | 2019-02-12 | 上海华测导航技术股份有限公司 | 一种基于单天线的gnss-ins车辆定姿方法 |
CN110793515A (zh) * | 2018-08-02 | 2020-02-14 | 哈尔滨工业大学 | 一种基于单天线gps和imu的大机动条件下无人机姿态估计方法 |
CN109212495B (zh) * | 2018-08-06 | 2023-03-03 | 中国航空工业集团公司雷华电子技术研究所 | 一种基于陀螺仪的雷达自动校靶方法及系统 |
CN109189717B (zh) * | 2018-09-07 | 2021-12-03 | 郑州信大先进技术研究院 | 一种多源数据同步采集系统 |
JP7223542B2 (ja) * | 2018-10-03 | 2023-02-16 | 古野電気株式会社 | 航法装置、航行支援情報の生成方法、および、航行支援情報の生成プログラム |
CN109724596A (zh) * | 2018-12-07 | 2019-05-07 | 江苏大学 | 一种基于最小二乘法和卡尔曼滤波的智能拖拉机定位方法 |
CN111912404B (zh) * | 2019-05-09 | 2024-04-05 | 西安京东天鸿科技有限公司 | 飞行设备输出姿态修正系统及方法 |
FR3107589B1 (fr) | 2020-02-21 | 2022-03-18 | Commissariat Energie Atomique | Procédé de détermination de la position et de l’orientation d’un véhicule. |
IL278232B (en) | 2020-10-21 | 2022-06-01 | Elbit Systems Ew And Sigint Elisra Ltd | A system and method for finding the direction of arrival of a radio signal transmitted from a radio transmitter and the location of the radio transmitter using a single antenna |
CN113405553B (zh) * | 2020-11-30 | 2023-05-26 | 辽宁工业大学 | 一种无人驾驶特种车辆姿态测量方法 |
CN112595348B (zh) * | 2020-12-16 | 2023-11-10 | 南京理工大学 | 用于商用车驾驶智能的imu数据标定系统及标定方法 |
CN112781617B (zh) * | 2020-12-28 | 2023-10-03 | 广州吉欧电子科技有限公司 | 误差估计方法、组合导航处理系统及存储介质 |
RU2769440C1 (ru) | 2021-05-18 | 2022-03-31 | Общество с ограниченной ответственностью «ЭвоКарго» | Способ комплексирования разнородной навигационной информации для позиционирования наземного транспортного средства |
CN114019954B (zh) * | 2021-10-12 | 2024-02-09 | 深圳元戎启行科技有限公司 | 航向安装角标定方法、装置、计算机设备和存储介质 |
CN113830220B (zh) * | 2021-11-04 | 2022-09-13 | 浙江欧飞电动车有限公司 | 基于信息融合的电动车助力控制方法 |
CN114235003B (zh) * | 2021-11-16 | 2023-08-18 | 中国航空工业集团公司雷华电子技术研究所 | 一种机载雷达天线运动参数的解算方法及测姿系统 |
CN114264302B (zh) * | 2021-12-14 | 2024-01-30 | 新纳传感系统有限公司 | 倾斜测量设备及其的惯性导航系统的初始化方法 |
CN114529985A (zh) * | 2022-01-19 | 2022-05-24 | 吉林大学 | 一种面向老年人日常复杂地形运动的意图识别方法 |
CN114485641B (zh) * | 2022-01-24 | 2024-03-26 | 武汉梦芯科技有限公司 | 一种基于惯导卫导方位融合的姿态解算方法及装置 |
CN116009044A (zh) * | 2023-03-16 | 2023-04-25 | 武汉理工大学 | 一种单天线船舶姿态测量方法、装置及电子设备 |
CN116222560B (zh) * | 2023-05-09 | 2023-06-30 | 北京航空航天大学 | 基于偏振时间差分的陀螺漂移与姿态失准角解耦估计方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20090222204A1 (en) * | 2008-02-28 | 2009-09-03 | Peter James Roberts | Vehicle guidance and sensor bias determination |
US20120221244A1 (en) * | 2011-02-28 | 2012-08-30 | Trusted Positioning Inc. | Method and apparatus for improved navigation of a moving platform |
CN103033836A (zh) * | 2012-12-19 | 2013-04-10 | 江苏科技大学 | 一种车载导航指向装置及方法 |
US20130127658A1 (en) * | 2011-11-22 | 2013-05-23 | Radio Systems Corporation | Method and Apparatus to Determine Actionable Position and Speed in GNSS Applications |
CN103235328A (zh) * | 2013-04-19 | 2013-08-07 | 黎湧 | 一种gnss与mems组合导航的方法 |
CN104698485A (zh) * | 2015-01-09 | 2015-06-10 | 中国电子科技集团公司第三十八研究所 | 基于bd、gps及mems的组合导航系统及导航方法 |
Family Cites Families (21)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7610146B2 (en) * | 1997-10-22 | 2009-10-27 | Intelligent Technologies International, Inc. | Vehicle position determining system and method |
US5928309A (en) * | 1996-02-05 | 1999-07-27 | Korver; Kelvin | Navigation/guidance system for a land-based vehicle |
JP2002354905A (ja) * | 2001-05-31 | 2002-12-10 | Yanmar Agricult Equip Co Ltd | 農業用作業車 |
US20030135327A1 (en) * | 2002-01-11 | 2003-07-17 | Seymour Levine | Low cost inertial navigator |
US7400956B1 (en) * | 2003-03-20 | 2008-07-15 | Hemisphere Gps Inc. | Satellite position and heading sensor for vehicle steering control |
US7885745B2 (en) * | 2002-12-11 | 2011-02-08 | Hemisphere Gps Llc | GNSS control system and method |
US8265826B2 (en) * | 2003-03-20 | 2012-09-11 | Hemisphere GPS, LLC | Combined GNSS gyroscope control system and method |
US9002565B2 (en) * | 2003-03-20 | 2015-04-07 | Agjunction Llc | GNSS and optical guidance and machine control |
US8140223B2 (en) * | 2003-03-20 | 2012-03-20 | Hemisphere Gps Llc | Multiple-antenna GNSS control system and method |
US6883747B2 (en) * | 2003-03-28 | 2005-04-26 | Northrop Grumman Corporation | Projectile guidance with accelerometers and a GPS receiver |
US8583315B2 (en) * | 2004-03-19 | 2013-11-12 | Agjunction Llc | Multi-antenna GNSS control system and method |
CA2742580A1 (en) * | 2008-11-04 | 2010-05-14 | National Research Council Of Canada | Propulsion system for an autonomous underwater vehicle |
CN102223707A (zh) * | 2010-04-15 | 2011-10-19 | 上海启电信息科技有限公司 | 一种移动定位信标装置 |
CA2802445C (en) * | 2010-06-25 | 2018-05-08 | Trusted Positioning Inc. | Moving platform ins range corrector (mpirc) |
JP5602070B2 (ja) * | 2011-03-15 | 2014-10-08 | 三菱電機株式会社 | 位置標定装置、位置標定装置の位置標定方法および位置標定プログラム |
CN102890278A (zh) | 2011-07-19 | 2013-01-23 | 哈尔滨伟方智能科技开发有限责任公司 | 基于fpga北斗的/mimu深组合导航系统 |
CA2848217C (en) * | 2011-09-14 | 2018-09-18 | Trusted Positioning Inc. | Method and apparatus for navigation with nonlinear models |
RU2483280C1 (ru) * | 2012-01-10 | 2013-05-27 | Антон Владимирович Чернявец | Навигационный комплекс |
KR101390906B1 (ko) * | 2012-08-21 | 2014-05-02 | 자동차부품연구원 | 타이어 방향 감지에 따른 방향 지시등 제어 시스템 및 그 방법 |
CN105823481B (zh) * | 2015-12-21 | 2019-02-12 | 上海华测导航技术股份有限公司 | 一种基于单天线的gnss-ins车辆定姿方法 |
FR3058229B1 (fr) * | 2016-10-27 | 2020-02-28 | Airbus Helicopters | Estimation, independante d'une mesure magnetique, de la vitesse et du cap d'un aeronef |
-
2015
- 2015-12-21 CN CN201510969458.2A patent/CN105823481B/zh active Active
-
2016
- 2016-07-04 WO PCT/CN2016/088345 patent/WO2017107434A1/zh active Application Filing
- 2016-07-04 EP EP16877247.3A patent/EP3396316B1/en active Active
- 2016-07-04 RU RU2017125951A patent/RU2662462C1/ru active
- 2016-07-04 KR KR1020177024309A patent/KR102018450B1/ko active IP Right Grant
- 2016-07-04 ES ES16877247T patent/ES2826887T3/es active Active
- 2016-07-04 PL PL16877247T patent/PL3396316T3/pl unknown
- 2016-07-04 US US15/547,062 patent/US10605605B2/en active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20090222204A1 (en) * | 2008-02-28 | 2009-09-03 | Peter James Roberts | Vehicle guidance and sensor bias determination |
US20120221244A1 (en) * | 2011-02-28 | 2012-08-30 | Trusted Positioning Inc. | Method and apparatus for improved navigation of a moving platform |
US20130127658A1 (en) * | 2011-11-22 | 2013-05-23 | Radio Systems Corporation | Method and Apparatus to Determine Actionable Position and Speed in GNSS Applications |
CN103033836A (zh) * | 2012-12-19 | 2013-04-10 | 江苏科技大学 | 一种车载导航指向装置及方法 |
CN103235328A (zh) * | 2013-04-19 | 2013-08-07 | 黎湧 | 一种gnss与mems组合导航的方法 |
CN104698485A (zh) * | 2015-01-09 | 2015-06-10 | 中国电子科技集团公司第三十八研究所 | 基于bd、gps及mems的组合导航系统及导航方法 |
Non-Patent Citations (3)
Title |
---|
吕鹏等: "基于INS加速度辅助GNSS导频信号自适应载波跟踪算法", 《清华大学学报(自然科学版)》 * |
甘雨等: "陆地导航中GNSS/陀螺仪组合实时测姿方法", 《武汉大学学报.信息科学版》 * |
翟海廷等: "基于单天线的MEMS_INS/GPS组合定姿方法", 《计算机工程与设计》 * |
Cited By (21)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106595656B (zh) * | 2016-12-29 | 2019-09-10 | 辽宁工程技术大学 | 一种基于车载pos的公路线形特征识别与参数计算方法 |
CN106595656A (zh) * | 2016-12-29 | 2017-04-26 | 辽宁工程技术大学 | 一种基于车载pos的公路线形特征识别与参数计算方法 |
CN107063241A (zh) * | 2017-03-16 | 2017-08-18 | 上海联适导航技术有限公司 | 基于双gnss天线及单轴mems陀螺的前轮测角系统 |
CN107063241B (zh) * | 2017-03-16 | 2023-08-25 | 上海联适导航技术股份有限公司 | 基于双gnss天线及单轴mems陀螺的前轮测角系统 |
CN108052106A (zh) * | 2018-01-19 | 2018-05-18 | 东南大学 | 一种基于ros的无人驾驶农机路径跟踪系统 |
CN108663036A (zh) * | 2018-04-04 | 2018-10-16 | 南京天辰礼达电子科技有限公司 | 一种车辆前轮转动跟踪系统及算法 |
CN108663036B (zh) * | 2018-04-04 | 2021-11-02 | 南京天辰礼达电子科技有限公司 | 一种车辆前轮转动跟踪的方法 |
CN110426011A (zh) * | 2018-04-28 | 2019-11-08 | 西安合众思壮导航技术有限公司 | 车辆转向角测量系统及方法 |
CN109443349A (zh) * | 2018-11-14 | 2019-03-08 | 广州中海达定位技术有限公司 | 一种姿态航向测量系统及其融合方法、存储介质 |
CN109917440B (zh) * | 2019-04-09 | 2021-07-13 | 广州小鹏汽车科技有限公司 | 一种组合导航方法、系统及车辆 |
CN109917440A (zh) * | 2019-04-09 | 2019-06-21 | 广州小鹏汽车科技有限公司 | 一种组合导航方法、系统及车辆 |
WO2021068650A1 (zh) * | 2019-10-07 | 2021-04-15 | 佛吉亚歌乐电子(丰城)有限公司 | 基于gps惯性导航的车载指南针实现方法及系统 |
CN111912426A (zh) * | 2020-08-10 | 2020-11-10 | 电子科技大学 | 一种基于mems imu的低成本里程计设计方法 |
CN112326990A (zh) * | 2020-10-22 | 2021-02-05 | 北京农业智能装备技术研究中心 | 一种作业车辆测速方法及系统 |
CN113391336A (zh) * | 2021-06-17 | 2021-09-14 | 上海联适导航技术股份有限公司 | 一种航向角的检测方法、装置、设备及可读存储介质 |
CN113534220A (zh) * | 2021-07-27 | 2021-10-22 | 联创汽车电子有限公司 | 车辆航向角计算方法、存储介质、计算单元和系统 |
CN113720336A (zh) * | 2021-08-10 | 2021-11-30 | 广东汇天航空航天科技有限公司 | 一种航向信息确定方法、车辆以及计算机可读存储介质 |
CN113720336B (zh) * | 2021-08-10 | 2022-11-22 | 广东汇天航空航天科技有限公司 | 一种航向信息确定方法、车辆以及计算机可读存储介质 |
CN114674271A (zh) * | 2022-02-11 | 2022-06-28 | 江苏大学 | 单天线gnss辅助陀螺仪的农机转向角测量方法及装置 |
CN114674271B (zh) * | 2022-02-11 | 2024-06-07 | 江苏大学 | 单天线gnss辅助陀螺仪的农机转向角测量方法及装置 |
CN115542363A (zh) * | 2022-11-24 | 2022-12-30 | 浙江航天润博测控技术有限公司 | 一种适用于垂直下视航空吊舱的姿态测量方法 |
Also Published As
Publication number | Publication date |
---|---|
WO2017107434A1 (zh) | 2017-06-29 |
US20180017390A1 (en) | 2018-01-18 |
CN105823481B (zh) | 2019-02-12 |
EP3396316A4 (en) | 2019-08-07 |
EP3396316A1 (en) | 2018-10-31 |
RU2662462C1 (ru) | 2018-07-26 |
KR20170109646A (ko) | 2017-09-29 |
PL3396316T3 (pl) | 2021-02-08 |
US10605605B2 (en) | 2020-03-31 |
ES2826887T3 (es) | 2021-05-19 |
KR102018450B1 (ko) | 2019-09-04 |
EP3396316B1 (en) | 2020-09-30 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105823481B (zh) | 一种基于单天线的gnss-ins车辆定姿方法 | |
CN104198765B (zh) | 车辆运动加速度检测的坐标系转换方法 | |
CN105203129B (zh) | 一种惯导装置初始对准方法 | |
CN104501838B (zh) | 捷联惯导系统初始对准方法 | |
CN105606094B (zh) | 一种基于mems/gps组合系统的信息条件匹配滤波估计方法 | |
US20210199438A1 (en) | Heading initialization method for tilt rtk | |
Wu et al. | Self-calibration for IMU/odometer land navigation: Simulation and test results | |
CN107315345A (zh) | 基于双天线gnss和预瞄追踪模型的农机自动导航控制方法 | |
CN103389092B (zh) | 一种系留飞艇姿态测量装置及测量方法 | |
CN109459044A (zh) | 一种gnss双天线辅助的车载mems惯导组合导航方法 | |
CN105987696A (zh) | 一种低成本车辆自动驾驶设计实现方法 | |
CN104697526A (zh) | 用于农业机械的捷联惯导系统以及控制方法 | |
CN105203098A (zh) | 基于九轴mems传感器的农业机械全姿态角更新方法 | |
CN201955092U (zh) | 一种基于地磁辅助的平台式惯性导航装置 | |
CN112595350B (zh) | 一种惯导系统自动标定方法及终端 | |
Cai et al. | Multi-antenna GNSS and INS integrated position and attitude determination without base station for land vehicles | |
CN108088443A (zh) | 一种定位定向设备速度补偿方法 | |
CN102589552A (zh) | 低成本组合导航系统的数据融合方法和装置 | |
CN105841698A (zh) | 一种无需调零的auv舵角精确实时测量系统 | |
CN109186597A (zh) | 一种基于双mems-imu的室内轮式机器人的定位方法 | |
CN103712621A (zh) | 偏振光及红外传感器辅助惯导系统定姿方法 | |
CN105606093B (zh) | 基于重力实时补偿的惯性导航方法及装置 | |
CN107703527A (zh) | 一种基于北斗三频单历元宽巷/超宽巷的组合定位方法 | |
CN112985420A (zh) | 小天体附着光学导航特征递推优选方法 | |
CN106323226B (zh) | 一种利用北斗测定惯性导航系统与测速仪安装夹角的方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |