[go: up one dir, main page]
More Web Proxy on the site http://driver.im/

CN104360366B - 航位推算和全球定位系统的组合定位方法 - Google Patents

航位推算和全球定位系统的组合定位方法 Download PDF

Info

Publication number
CN104360366B
CN104360366B CN201410618043.6A CN201410618043A CN104360366B CN 104360366 B CN104360366 B CN 104360366B CN 201410618043 A CN201410618043 A CN 201410618043A CN 104360366 B CN104360366 B CN 104360366B
Authority
CN
China
Prior art keywords
vehicle
speed
gps
output
microprocessor
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
Application number
CN201410618043.6A
Other languages
English (en)
Other versions
CN104360366A (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.)
HANGZHOU ZHONGKE MICROELECTRONICS CO Ltd
Original Assignee
JIAXING MICROELECTRONICS AND SYSTEMS ENGINEERING CENTER CHINESE ACADEMY OF SCIENCES
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 JIAXING MICROELECTRONICS AND SYSTEMS ENGINEERING CENTER CHINESE ACADEMY OF SCIENCES filed Critical JIAXING MICROELECTRONICS AND SYSTEMS ENGINEERING CENTER CHINESE ACADEMY OF SCIENCES
Priority to CN201410618043.6A priority Critical patent/CN104360366B/zh
Publication of CN104360366A publication Critical patent/CN104360366A/zh
Application granted granted Critical
Publication of CN104360366B publication Critical patent/CN104360366B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • 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
    • 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

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)

Abstract

本发明公开了一种航位推算和全球定位系统的组合定位方法，包括初始化组合定位参量以待用于DR系统、GPS定位以判断是否启用DR系统以及DR和GPS组合定位。在DR和GPS组合定位中，DR系统输出的车辆的位置和速度与GPS接收机输出的位置和速度的差值被输入卡尔曼滤波器以获取校正值，通过该校正值和DR系统输出的位置和速度获取组合定位的位置和速度。本发明可以有效解决城市道路复杂环境下单GPS系统定位不连续不可靠的问题，本发明只需要使用两个里程计而不需要使用陀螺仪加速度计等惯性传感器辅助，就能实时校正DR系统的输出，使其不累积误差，本发明的实现方法简便可靠。

Description

航位推算和全球定位系统的组合定位方法
技术领域
本发明涉及车辆定位技术，尤其涉及一种航位推算和全球定位系统的组合定位方法。
背景技术
车辆定位技术是实现行车路线引导的关键技术，GPS(全球定位系统)凭借其定位迅速、准确，以及在无遮挡情况下可实现全天候定位的特点，成为当前首选的车辆定位技术。但是，在当今的城市道路环境下，单独使用GPS导航定位系统的车辆信号经常会受到高楼、树木、高架桥等物体的遮挡，导致其定位不连续以及定位精度低等问题。因此GPS导航定位系统需要和其他导航系统进行组合，以获得较高的导航定位质量。
在常与GPS导航定位系统组合的导航系统中，惯性导航系统由于惯性测量单元价格较高，实现方法复杂，因此被较少应用。经常和GPS组合应用在车载组合导航中的是DR(航道推算)导航定位方式，其通常的做法有三种：1、一个里程计加一个单轴陀螺仪；2、一个单轴陀螺仪加一个单轴加速度计；3、两个里程计差分。由于前两种方案都需要用到惯性传感器，而目前可用于车辆导航的惯性传感器价格昂贵，且相应数据处理方法复杂，不适用于车载DR导航定位。另外，由于DR导航系统是基于位置推测的，其误差会随时间累积。
因此，本领域的技术人员致力于开发一种航位推算和全球定位系统的组合定位方法，无需使用惯性传感器，且能消除其中DR导航的随时间累积的误差。
发明内容
有鉴于现有技术的上述缺陷，本发明所要解决的技术问题是提供一种航位推算和全球定位系统的组合定位方法，消除其中DR导航的随时间累积的误差。
为实现上述目的，本发明提供了一种航位推算和全球定位系统的组合定位方法，用于对车辆导航定位，其特征在于，包括：
步骤100，初始化组合定位参量并将所述参量输入微处理器，所述参量包括所述车辆的车轮的半径和后轮间距；
步骤200，GPS定位，包括：
启动GPS接收机；当所述GPS接收机的GPS定位成功，且当所述车辆的速度大于设定值时，进入步骤300；
步骤300，DR和GPS组合定位，包括：
步骤310，所述微处理器将所述步骤100中获取的所述参量输入所述DR系统，所述微处理器将完成所述步骤200后的所述GPS接收机输出的所述车辆的位置和速度输入所述DR系统；
步骤320，所述微处理器将所述DR系统接收的所述车辆的位置和速度作为所述DR系统采用的初始位置和初始速度，对所述DR系统进行初始化；所述微处理器启动DR系统；
步骤330，所述微处理器指令所述DR系统工作，所述DR系统输出所述车辆的位置和速度；
步骤340，所述微处理器将所述DR系统输出的所述车辆的位置和速度以及所述GPS接收机输出的所述车辆的速度和位置输入卡尔曼滤波器以对所述DR系统输出的所述位置和速度进行校正；
步骤350，所述微处理器根据所述卡尔曼滤波器输出的所述车辆的位置和速度的校正量以及所述DR系统输出的所述车辆的位置和速度，计算获得所述车辆的组合定位的位置和速度，并将所述的组合定位的位置和速度输出；
步骤360，所述微处理器将所述组合定位的位置和速度输入所述DR系统，进入步骤320。
进一步地，所述DR系统和所述卡尔曼滤波器在所述微处理器中，所述GPS接收机通过串口连接到所述微处理器，所述车辆包括左轮里程计和右轮里程计分别连接到所述微处理器，所述左轮里程计与所述微处理器间的通信通过外部中断1触发，所述右轮里程计与所述微处理器间的通信通过外部中断2触发。
进一步地，所述左轮是左后轮，所述右轮是右后轮。
进一步地，所述步骤200包括：
步骤210，GPS接收机接收卫星信号；
步骤220，所述微处理器判断GPS接收机是否定位成功，如果判断为是，则进入步骤230，如判断为否，则进入步骤210；
步骤230，所述GPS接收机输出所述车辆的位置和速度，所述微处理器根据所述GPS输出的所述车辆的速度以及所述左轮里程计和所述右轮里程计输出的脉冲频率判断所述车辆的速度是否大于所述设定值，如果判断为是，则进入所述步骤310，如果判断为否，则进入步骤210。
进一步地，所述GPS接收机输出的所述车辆的位置包括经度、纬度和高度，所述DR系统输出的所述车辆的位置包括经度、纬度和高度，所述GPS接收机输出的所述车辆的速度包括东向速度、北向速度和偏航角，所述DR系统输出的所述车辆的速度包括东向速度、北向速度和偏航角。
进一步地，所述DR系统基于DR算法工作，所述DR算法根据所述车辆的车轮的半径和后轮间距、初始位置和初始速度以及行驶中的所述车辆的所述左轮和所述右轮在一个计算周期内通过的距离来获得所述车辆在所述一个计算周期末的位置和速度。
进一步地，所述车辆的所述左轮在一个计算周期内通过的距离由所述左轮里程计输出，所述车辆的所述右轮在一个计算周期内通过的距离由所述右轮里程计输出。
进一步地，所述步骤340包括：
步骤341，所述微处理器判断GPS接收机是否定位成功，如果判断为是，则进入步骤342，如判断为否，则进入步骤343；
步骤342，所述微处理器将所述DR系统输出的所述车辆的位置和速度与所述GPS输出的所述车辆的位置和速度相减以获得差值，并将所述差值作为所述卡尔曼滤波器的量测值；进入步骤344；
步骤343，所述微处理器将一个零向量作为所述卡尔曼滤波器的量测值；进入步骤344；
步骤344，所述卡尔曼滤波器依次使用卡尔曼滤波的状态方程和卡尔曼滤波的量测方程以对所述DR系统输出的所述位置和速度进行校正；
所述卡尔曼滤波的状态方程为：其中，t为时间，系统状态转移矩阵F(t)是一个单位矩阵，系统过程噪声序列W(t)是一个均值为0、方差为Q(t)、呈正态分布的函数，状态向量X(t)为所述量测值；当所述步骤341的判断为是的时候，状态向量X＝[Δlon Δlat Δhed ΔVn ΔVe]T中的⊿lon为所述GPS接收机输出的所述车辆的经度和所述DR系统输出的所述车辆的经度之间的差值，⊿lat为所述GPS接收机输出的所述车辆的纬度和所述DR系统输出的所述车辆的纬度之间的差值，⊿hed为所述GPS接收机输出的所述车辆的偏航角和所述DR系统输出的所述车辆的偏航角之间的差值，⊿Vn为所述GPS接收机输出的所述车辆的北向速度和所述DR系统输出的所述车辆的北向速度之间的差值，⊿Ve为所述GPS接收机输出的所述车辆的东向速度和所述DR系统输出的所述车辆的东向速度之间的差值；当所述步骤341的判断为否的时候，状态向量X＝[0 0 0 0 0]T；
所述卡尔曼滤波的观测方程为：其中，观测矩阵C(t)为一个单位矩阵，测量噪声序列V(t)为一个均值为0、方差为R(t)、呈正态分布的函数；当所述步骤341的判断为是的时候，观测向量Y(t)取为：
yk＝[Δlon Δlat Δhed ΔVn ΔVe]T；当所述步骤341的判断为否的时候，观测向量Y(t)取为：yk＝[0 0 0 0 0]T；
所述为中间量，所述Y(t)为所述车辆的位置和速度的校正量。
进一步地，⊿lon等于所述DR系统输出的所述车辆的经度减去所述GPS接收机输出的所述车辆的经度，⊿lat等于所述DR系统输出的所述车辆的纬度减去所述GPS接收机输出的所述车辆的纬度，⊿hed等于所述DR系统输出的所述车辆的偏航角减去所述GPS接收机输出的所述车辆的偏航角，⊿Vn等于所述DR系统输出的所述车辆的北向速度减去所述GPS接收机输出的所述车辆的北向速度，⊿Ve等于所述DR系统输出的所述车辆的东向速度减去所述GPS接收机输出的所述车辆的东向速度。
进一步地，所述车辆的组合定位的位置和速度分别地等于所述DR系统输出的所述车辆的位置和速度分别地减去所述卡尔曼滤波器输出的所述车辆的位置和速度的校正量。
在本发明的较佳实施方式中，应用了上述的组合定位方法，其在GPS定位无效的时候，依然能较好的体现运行中的车辆的真实位置。
本发明的航位推算和全球定位系统的组合定位方法具有以下优点：
1)相比于单独的GPS导航定位系统，本方法只额外使用了两个里程计(左轮里程计和右轮里程计)，用来作为DR系统的信号输入；相比于常与GPS导航定位系统组合的导航系统，本发明无需用到陀螺仪加速度计等惯性器件，处理方法简洁高效可靠；
2)本发明中启动DR系统的方式能确保DR系统初始化对准快速、正确；
3)本发明的工作机制清晰，便于维护。在GPS定位不正常的情况下，其仍然可以在较长时间内保持有效定位；
4)本发明能实时校正DR系统，使其随时间产生的误差不被累积；
5)本发明成本较低。
以下将结合附图对本发明的构思、具体结构及产生的技术效果作进一步说明，以充分地了解本发明的目的、特征和效果。
附图说明
图1是本发明的航位推算和全球定位系统的组合定位方法的流程图。
图2是本发明中的卡尔曼滤波器的工作原理框图。
图3是在一个较佳实施例中，实现本发明的航位推算和全球定位系统的组合定位方法的系统结构框图。
图4显示了图3所示的系统实施本发明的航位推算和全球定位系统的组合定位方法的仿真结果。
具体实施方式
图1示出了本发明的航位推算和全球定位系统的组合定位方法的流程图，在本实施例中，其应用于如图3所示的系统。该系统包括微处理器、GPS接收机和两个里程计(左轮里程计及右轮里程计)，其中微处理器中有DR系统和所述卡尔曼滤波器，GPS接收机通过串口连接到微处理器，左轮里程计和右轮里程计分别连接到微处理器，左轮里程计与微处理器间的通信通过外部中断1触发，右轮里程计与微处理器间的通信通过外部中断2触发。其中左轮是车辆的左后轮，右轮是车辆的右后轮，左轮里程计及右轮里程计分别计量左轮和右轮经过的里程。
本发明的航位推算和全球定位系统的组合定位方法具体地为：
步骤100，初始化组合定位参量并将这些参量输入微处理器。这些参量是与DR系统的工作相关的常数，包括车辆的车轮的半径和后轮间距。
本实施例中，车辆的车轮的半径为0.33米，后轮间距为1.55米。
步骤200，GPS定位。
首先不启动DR系统，而进行GPS独立的定位，具体地包括步骤210、220和230：
步骤210，GPS接收机接收卫星信号。这是GPS接收机的工作方式，在此不赘述。
步骤220，微处理器判断GPS接收机是否定位成功，如果判断为是，则进入步骤230，如判断为否，则进入步骤210；
步骤230，GPS接收机输出车辆的位置和速度，微处理器根据GPS输出的车辆的速度以及左轮里程计和右轮里程计输出的脉冲频率判断该车辆的速度是否大于设定值，如果判断为是，则进入所述步骤310，如果判断为否，则进入步骤210。
这里的设定值，是启动DR系统的最小车速，即只有当车辆的速度到达一定值时，才启动DR系统，否则还是保持GPS的独立定位。一般地，该设定值取为10Km/h。
步骤300，DR和GPS组合定位，其具体地包括步骤310、320、330、340、350和360。
步骤310，微处理器将步骤100中获取的那些参量输入DR系统，微处理器将完成步骤200后的GPS接收机输出的车辆的位置和速度输入DR系统。
GPS接收机输出的车辆的位置包括经度、纬度和高度，GPS接收机输出的车辆的速度包括东向速度、北向速度和偏航角。
步骤320，微处理器将DR系统接收的车辆的位置和速度作为DR系统采用的初始位置和初始速度，对DR系统进行初始化；微处理器启动DR系统。
步骤330，微处理器指令DR系统工作，DR系统输出车辆的位置和速度。
本步骤中，DR系统基于DR算法工作，其根据车辆的车轮的半径和后轮间距、初始位置和初始速度以及行驶中的车辆的左轮和右轮在一个计算周期内通过的距离来获得所述车辆在这个计算周期末的位置和速度并将该位置和速度输出。其中，车辆的左轮在一个计算周期内通过的距离由左轮里程计输出，车辆的右轮在一个计算周期内通过的距离由右轮里程计输出。
计算周期可以设定，本实施例中选用的计算周期为1秒。
DR系统输出的车辆的位置包括经度、纬度和高度，DR系统输出的车辆的速度包括东向速度、北向速度和偏航角。
步骤340，微处理器将DR系统输出的车辆的位置和速度以及GPS接收机输出的车辆的速度和位置输入卡尔曼滤波器以对DR系统输出的位置和速度进行校正，具体地包括步骤341、342、343和344。
步骤341，微处理器判断GPS接收机是否定位成功，如果判断为是，则进入步骤342，如判断为否，则进入步骤343。
步骤342，微处理器将DR系统输出的车辆的位置和速度与GPS输出的车辆的位置和速度相减以获得差值，并将该差值作为卡尔曼滤波器的量测值；进入步骤344。
参见图2所示的卡尔曼滤波器的工作原理框图，本实施例中是用DR系统输出的车辆的位置和速度分别地减去GPS输出的车辆的位置和速度，由此获得差值⊿lon、⊿lat、⊿hed、⊿Vn和⊿Ve，其中，⊿lon等于DR系统输出的车辆的经度减去GPS接收机输出的车辆的经度，⊿lat等于DR系统输出的车辆的纬度减去GPS接收机输出的车辆的纬度，⊿hed等于DR系统输出的车辆的偏航角减去GPS接收机输出的车辆的偏航角，⊿Vn等于DR系统输出的车辆的北向速度减去GPS接收机输出的车辆的北向速度，⊿Ve等于DR系统输出的车辆的东向速度减去GPS接收机输出的车辆的东向速度。由此，卡尔曼滤波器的量测值为状态向量X＝[Δlon Δlat Δhed ΔVn ΔVe]T。
步骤343，微处理器将一个零向量作为卡尔曼滤波器的量测值；进入步骤344。即认为GPS接收机与DR系统具有相同的输出，由此卡尔曼滤波器的量测值为状态向量X＝[ΔlonΔlat Δhed ΔVn ΔVe]T＝[0 0 0 0 0]T。
步骤344，卡尔曼滤波器依次使用卡尔曼滤波的状态方程和卡尔曼滤波的量测方程以对所述DR系统输出的所述位置和速度进行校正。
首先使用卡尔曼滤波的状态方程：式中，t为时间，系统状态转移矩阵F(t)是一个单位矩阵，系统过程噪声序列W(t)是一个均值为0、方差为Q(t)、呈正态分布的函数。这里为中间量，可以认为它是对X(t)的估值。本实施例中，方差Q(t)被设置为0.2乘以单位矩阵。
然后使用卡尔曼滤波的观测方程为：式中，观测向量Y(t)取为：yk＝[Δlon Δlat Δhed ΔVn ΔVe]T，观测矩阵C(t)为一个单位矩阵，测量噪声序列V(t)为一个均值为0、方差为R(t)、呈正态分布的函数。本实施例中，方差R(t)被设置为0.4乘以单位矩阵。
卡尔曼滤波器输出的Y(t)为车辆的位置和速度的校正量。
步骤350，微处理器根据卡尔曼滤波器输出的车辆的位置和速度的校正量以及DR系统输出的车辆的位置和速度，计算获得车辆的组合定位的位置和速度，并将该组合定位的位置和速度输出。
如图2所示，本实施例中车辆的组合定位的位置和速度分别地等于DR系统输出的车辆的位置和速度分别地减去卡尔曼滤波器输出的车辆的位置和速度的校正量。
步骤360，微处理器将上述组合定位的位置和速度输入DR系统，进入步骤320。由此DR系统开始对下一个计算周期末的车辆的位置和速度进行推算。
本实施例通过使用Spirent公司生产的模拟器并编辑一段车辆行驶轨迹来模拟车辆运行，模拟器在运行编辑好的轨迹时可以给出每一时刻标准的经、纬度，同时输出相对应的卫星信号以及车辆左右后轮的里程计信号。在运行场景时，人为地在一些时间段切断GPS信号，使用本发明的航位推算和全球定位系统的组合定位方法进行组合导航计算，同时将标准位置信息、GPS接收机输出的位置信息和本发明组合导航计算得到的位置信息绘制于图4。由图4可以看出在GPS定位无效的时候，本发明依然能较好的体现车辆的真实位置。
以上详细描述了本发明的较佳具体实施例。应当理解，本领域的普通技术人员无需创造性劳动就可以根据本发明的构思做出诸多修改和变化。因此，凡本技术领域的技术人员依本发明的构思在现有技术的基础上通过逻辑分析、推理或者有限的实验可以得到的技术方案，皆应在由权利要求书所确定的保护范围内。

Claims (1)

1.一种航位推算和全球定位系统的组合定位方法，用于对车辆导航定位，其特征在于，包括：
步骤100，初始化组合定位参量并将所述参量输入微处理器，所述参量包括所述车辆的车轮的半径和后轮间距；
步骤200，GPS定位，包括：
启动GPS接收机；当所述GPS接收机的GPS定位成功，且当所述车辆的速度大于设定值时，进入步骤300；
步骤300，DR和GPS组合定位，包括：
步骤310，所述微处理器将所述步骤100中获取的所述参量输入所述DR系统，所述微处理器将完成所述步骤200后的所述GPS接收机输出的所述车辆的位置和速度输入所述DR系统；
步骤320，所述微处理器将所述DR系统接收的所述车辆的位置和速度作为所述DR系统采用的初始位置和初始速度，对所述DR系统进行初始化；所述微处理器启动DR系统；
步骤330，所述微处理器指令所述DR系统工作，所述DR系统输出所述车辆的位置和速度；
步骤340，所述微处理器将所述DR系统输出的所述车辆的位置和速度以及所述GPS接收机输出的所述车辆的速度和位置输入卡尔曼滤波器以对所述DR系统输出的所述位置和速度进行校正；
步骤350，所述微处理器根据所述卡尔曼滤波器输出的所述车辆的位置和速度的校正量以及所述DR系统输出的所述车辆的位置和速度，计算获得所述车辆的组合定位的位置和速度，并将所述的组合定位的位置和速度输出；
步骤360，所述微处理器将所述组合定位的位置和速度输入所述DR系统，进入步骤320；
其中所述DR系统和所述卡尔曼滤波器在所述微处理器中，所述GPS接收机通过串口连接到所述微处理器，所述车辆包括左轮里程计和右轮里程计分别连接到所述微处理器，所述左轮里程计与所述微处理器间的通信通过外部中断1触发，所述右轮里程计与所述微处理器间的通信通过外部中断2触发；
其中所述左轮是左后轮，所述右轮是右后轮；
其中所述步骤200包括：
步骤210，GPS接收机接收卫星信号；
步骤220，所述微处理器判断GPS接收机是否定位成功，如果判断为是，则进入步骤230，如判断为否，则进入步骤210；
步骤230，所述GPS接收机输出所述车辆的位置和速度，所述微处理器根据所述GPS输出的所述车辆的速度以及所述左轮里程计和所述右轮里程计输出的脉冲频率判断所述车辆的速度是否大于所述设定值，如果判断为是，则进入所述步骤310，如果判断为否，则进入步骤210；
其中所述GPS接收机输出的所述车辆的位置包括经度、纬度和高度，所述DR系统输出的所述车辆的位置包括经度、纬度和高度，所述GPS接收机输出的所述车辆的速度包括东向速度、北向速度和偏航角，所述DR系统输出的所述车辆的速度包括东向速度、北向速度和偏航角；
其中所述DR系统基于DR算法工作，所述DR算法根据所述车辆的车轮的半径和后轮间距、初始位置和初始速度以及行驶中的所述车辆的所述左轮和所述右轮在一个计算周期内通过的距离来获得所述车辆在所述一个计算周期末的位置和速度；其中所述车辆的所述左轮在一个计算周期内通过的距离由所述左轮里程计输出，所述车辆的所述右轮在一个计算周期内通过的距离由所述右轮里程计输出；
其中所述步骤340包括：
步骤341，所述微处理器判断GPS接收机是否定位成功，如果判断为是，则进入步骤342，如判断为否，则进入步骤343；
步骤342，所述微处理器将所述DR系统输出的所述车辆的位置和速度与所述GPS输出的所述车辆的位置和速度相减以获得差值，并将所述差值作为所述卡尔曼滤波器的量测值；进入步骤344；
步骤343，所述微处理器将一个零向量作为所述卡尔曼滤波器的量测值；
进入步骤344；
步骤344，所述卡尔曼滤波器依次使用卡尔曼滤波的状态方程和卡尔曼滤波的量测方程以对所述DR系统输出的所述位置和速度进行校正；
所述卡尔曼滤波的状态方程为：X(t)＝F(t)X(t)+W(t)；其中，t为时间，系统状态转移矩阵F(t)是一个单位矩阵，系统过程噪声序列W(t)是一个均值为0、方差为Q(t)、呈正态分布的函数，状态向量X(t)为所述量测值；当所述步骤341的判断为是的时候，状态向量X＝[Δlon Δlat Δhed ΔVn ΔVe]T中的⊿lon为所述GPS接收机输出的所述车辆的经度和所述DR系统输出的所述车辆的经度之间的差值，⊿lat为所述GPS接收机输出的所述车辆的纬度和所述DR系统输出的所述车辆的纬度之间的差值，⊿hed为所述GPS接收机输出的所述车辆的偏航角和所述DR系统输出的所述车辆的偏航角之间的差值，⊿Vn为所述GPS接收机输出的所述车辆的北向速度和所述DR系统输出的所述车辆的北向速度之间的差值，⊿Ve为所述GPS接收机输出的所述车辆的东向速度和所述DR系统输出的所述车辆的东向速度之间的差值；当所述步骤341的判断为否的时候，状态向量X＝[0 0 0 0 0]T；
所述卡尔曼滤波的观测方程为：其中，观测矩阵C(t)为一个单位矩阵，测量噪声序列V(t)为一个均值为0、方差为R(t)、呈正态分布的函数；当所述步骤341的判断为是的时候，观测向量Y(t)取为：yk＝[Δlon Δlat Δhed ΔVn ΔVe]T；当所述步骤341的判断为否的时候，观测向量Y(t)取为：yk＝[0 0 0 0 0]T；
所述为中间量，所述Y(t)为所述车辆的位置和速度的校正量；
其中⊿lon等于所述DR系统输出的所述车辆的经度减去所述GPS接收机输出的所述车辆的经度，⊿lat等于所述DR系统输出的所述车辆的纬度减去所述GPS接收机输出的所述车辆的纬度，⊿hed等于所述DR系统输出的所述车辆的偏航角减去所述GPS接收机输出的所述车辆的偏航角，⊿Vn等于所述DR系统输出的所述车辆的北向速度减去所述GPS接收机输出的所述车辆的北向速度，⊿Ve等于所述DR系统输出的所述车辆的东向速度减去所述GPS接收机输出的所述车辆的东向速度；
其中所述车辆的组合定位的位置和速度分别地等于所述DR系统输出的所述车辆的位置和速度分别地减去所述卡尔曼滤波器输出的所述车辆的位置和速度的校正量。
CN201410618043.6A 2014-11-05 2014-11-05 航位推算和全球定位系统的组合定位方法 Active CN104360366B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201410618043.6A CN104360366B (zh) 2014-11-05 2014-11-05 航位推算和全球定位系统的组合定位方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201410618043.6A CN104360366B (zh) 2014-11-05 2014-11-05 航位推算和全球定位系统的组合定位方法

Publications (2)

Publication Number Publication Date
CN104360366A CN104360366A (zh) 2015-02-18
CN104360366B true CN104360366B (zh) 2017-02-08

Family

ID=52527646

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201410618043.6A Active CN104360366B (zh) 2014-11-05 2014-11-05 航位推算和全球定位系统的组合定位方法

Country Status (1)

Country Link
CN (1) CN104360366B (zh)

Families Citing this family (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102014211175A1 (de) * 2014-06-11 2015-12-17 Continental Teves Ag & Co. Ohg Verfahren und System zur Initialisierung eines Sensorfusionssystems
CN204535717U (zh) * 2015-03-13 2015-08-05 北京握奇智能科技有限公司 一种车载单元
CN104880717B (zh) * 2015-05-27 2017-05-17 中国科学院嘉兴微电子与系统工程中心 一种卫星测量值多路径误差检测装置及其算法
CN104931051A (zh) * 2015-06-08 2015-09-23 南京理工大学 基于大数据的室内电子地图绘制和导航方法及其系统
CN106781271A (zh) * 2016-11-21 2017-05-31 南京邮电大学 一种基于加速度传感器的老年人跌倒救助系统和方法
IT201700087876A1 (it) * 2017-07-31 2019-01-31 St Microelectronics Srl Sistema per la navigazione di veicoli terrestri e procedimento corrispondenti
CN109001789B (zh) * 2018-06-05 2020-05-22 西安交通大学 一种基于互相关熵配准的无人车定位融合方法
CN111350637B (zh) * 2018-12-20 2023-11-17 北京金风科创风电设备有限公司 卫星航向数据的处理方法和装置
CN109900296A (zh) * 2019-03-22 2019-06-18 华南农业大学 一种农机作业行驶速度检测系统及检测方法
CN110068338A (zh) * 2019-04-30 2019-07-30 杭州视氪科技有限公司 一种路线记忆系统及方法
CN110555801B (zh) * 2019-07-26 2024-08-16 纵目科技（上海）股份有限公司 一种航迹推演的校正方法、终端和存储介质
CN110749328B (zh) * 2019-08-30 2021-12-28 华为技术有限公司 定位方法与系统、电子设备、车辆与存储介质
CN114440864B (zh) * 2020-10-30 2024-06-25 华为技术有限公司 一种汽车定位的方法及装置
CN114114355B (zh) * 2021-10-27 2025-03-25 重庆广播电视大学重庆工商职业学院 一种基于航位推算协同的车联网定位精度提升系统及方法

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8239133B2 (en) * 2008-07-02 2012-08-07 O2Micro, International Global positioning system and dead reckoning (GPSandDR) integrated navigation system
CN102608641A (zh) * 2012-03-30 2012-07-25 江苏物联网研究发展中心 单轴陀螺仪和单轴加速度计的车载组合导航系统及方法

Also Published As

Publication number Publication date
CN104360366A (zh) 2015-02-18

Similar Documents

Publication Publication Date Title
CN104360366B (zh) 航位推算和全球定位系统的组合定位方法
CN208635810U (zh) 用于陆地车辆导航的系统以及车辆
CN104061899B (zh) 一种基于卡尔曼滤波的车辆侧倾角与俯仰角估计方法
CN109343095B (zh) 一种车载导航车辆组合定位装置及其组合定位方法
CN101514900B (zh) 一种单轴旋转的捷联惯导系统初始对准方法
CN104515527B (zh) 一种无gps信号环境下的抗粗差组合导航方法
CN104316059B (zh) 由里程计获得车辆经纬度的航位推算导航定位方法及系统
JP6260114B2 (ja) 走行路情報生成装置
CN103256937B (zh) 路径匹配的方法及装置
CN103727941A (zh) 基于载体系速度匹配的容积卡尔曼非线性组合导航方法
EP1550840A1 (en) Device and method for detecting current position of a moving vehicle
CN107247275B (zh) 基于公交车的城市gnss脆弱性监测系统及其方法
CN104180821B (zh) 一种基于同步测量与定位计算的里程计标定方法
CN205940567U (zh) 一种车载组合导航定位系统
JP2011523703A (ja) ロードマップを構築し、乗物の位置を判別する方法及びシステム
CN104977002A (zh) 基于sins/双od的惯性组合导航系统及其导航方法
CN111868479A (zh) 基于车辆测量数据处理的车辆操作
CN108051839A (zh) 一种车载三维定位装置及三维定位的方法
EP3018030A1 (en) Device for the detection of the attitude of motor vehicles and corresponding method
JP3753833B2 (ja) 道路線形自動測量装置
CN105403219A (zh) 一种基于mems的自行车导航系统
CN112432642A (zh) 一种重力灯塔与惯性导航融合定位方法及系统
CN106093992A (zh) 一种基于cors的亚米级组合定位导航系统及导航方法
CN115060257A (zh) 一种基于民用级惯性测量单元的车辆变道检测方法
CN104567888A (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
C14 Grant of patent or utility model
GR01 Patent grant
TR01 Transfer of patent right

Effective date of registration: 20230621

Address after: 310053 room 1001, innovation building, 3850 Jiangnan Road, high tech (Binjiang), Hangzhou, Zhejiang

Patentee after: Hangzhou Zhongke Microelectronics Co.,Ltd.

Address before: 314006 Building 2, No. 778, Asia Pacific Road, Jiaxing, Zhejiang Province (Jiaxing Technopole)

Patentee before: JIAXING MICROELECTRONICS AND SYSTEM ENGINEERING CENTER, CHINESE ACADEMY OF SCIENCES

TR01 Transfer of patent right