第五章 GPS-DR组合导航
位置-姿态并行滤波的DR GPS组合导航算法
ＧＰＳ／ＤＲ组合导航系统是解决移动车辆在ＧＰＳ卫星信号受遮挡时，仍能有效地定位问题的主要手段之一。
早期的ＧＰＳ／ＤＲ组合导航算法没有考虑航向角的估计问题［１］，只是综合ＧＰＳ和ＤＲ的导航参数信息得出定位结果，一旦ＧＰＳ失效航位推算系统的航向角偏差将导致位置推算精度较差。
随着算法的深入研究将航向角或航向角误差作为状态量参与滤波估计，但是其状态方程是非线性的，线性化过程会引入模型误差［２，３］，而且以往的航位推算往往因为是二维定位而忽略了俯仰角的计算。
虽然较小的坡度对定位精度的影响远小于陀螺等惯性器件的漂移对定位造成的影响，但车辆在大坡度或城市高架桥等地况行驶时车体的俯仰对航向角的测量影响不可忽视。
本文就如何利用低成本的ＤＲ和ＧＰＳ进行姿态、位置组合进行了研究，以卡尔曼滤波为基础，提出了带反馈的位置、姿态角并行滤波器结构，其状态方程都是线性的，既简化了滤波方程，又满足了各子系统对滤波周期的要求。
并针对各子系统的特点分别设计滤波算法，根据姿态角滤波器观测方程的非线性和观测量的冗余性，设计了噪声方差阵自动加权扩展卡尔曼滤波算法。
文章最后给出了静态和动态试验结果，验证了该方法的有效性。
１位置－姿态并行滤波器结构多传感器组合导航系统的主系统一般都是自主式导航，虽然有误差积累，但不受外界环境的干扰，可以连续定位。
而卫星导航系统定位精度高，无误差积累，但易受外界环境干扰，信号一旦丢失将无法定位，因此选其为辅助导航系统。
本文选取ＤＲ为主系统，以ＧＰＳ作为辅助导航系统采用直接滤波法，即以主导航系统输出的导航参数（例如东向位置，北向位置等）为滤波器状态变量，当ＧＰＳ接收机能够正常工作时，辅助导航系统输出的导航参数作为观测量，滤波器输出的导航参数估计值就是系统最终的定位结果；当ＧＰＳ接收机受到屏蔽不能正常工作时，主导航系统仍然能通过推算提供导航信息。
本文滤波器采用位置、角度分别滤波的并联滤波器结构。
一般来说１Ｈｚ的采样频率可以满足位置对数据更新率的要求，但远不能满足角度测量要求，本文角速率的采样频率为１０Ｈｚ，同时为避免量测相关问题要求位置滤波周期要大于ＧＰＳ的位置时间相关常数，因此采用位置、角速度并行滤波方式，位置子滤波器以较长的滤波周期处理位置数据，角度子滤波器以较短的周期处理姿态角数据，既满足了位置和角度对滤波周期要求，又便于根据各子系统的特点设计相应的滤波算法。
基于GPS-DR-MM组合导航AGV定位系统研究
基于GPS-DR-MM组合导航AGV定位系统研究基于GPS/DR/MM组合导航AGV定位系统研究摘要：随着自动化技术的不断发展，自动导引车（AGV）在物流、制造业等领域中得到了广泛应用。
AGV的准确定位是实现其自主导航的关键技术之一。
本文基于GPS/DR/MM组合导航技术对AGV定位系统进行了研究。
关键词：AGV；定位系统；GPS；DR；MM；组合导航1. 引言自动导引车（Automated Guided Vehicle，AGV）是一种能够提供自主导航功能的无人车辆，广泛应用于物流、制造业等领域。
AGV的自主导航依赖于准确的定位技术，而传统的单一定位技术由于受制于环境因素，难以达到高精度定位的要求。
因此，采用多种定位技术的组合导航成为解决AGV定位问题的有效方法。
2. GPS定位技术全球定位系统（Global Positioning System，GPS）是一种采用卫星定位原理的导航系统，具有全球覆盖、高精度等特点。
AGV可通过接收GPS卫星信号获取自身的经纬度信息，从而得到位置信息。
然而，GPS定位存在误差，尤其在城市峡谷、高楼大厦等复杂环境中定位精度会降低。
3. 惯性导航技术惯性导航（Dead Reckoning，DR）是通过测量车辆自身的加速度和角速度来估计位移和方向。
DR技术不依赖于外部参考信号，可以实现实时定位。
然而，DR技术存在漂移问题，随着时间的推移误差会逐渐积累，导致定位精度下降。
4. 微波测距技术无线微波测距（Microwave Ranging，MM）技术是一种通过测量无线微波信号的传播时间来确定距离的技术。
MM技术可以提供高精度的距离信息，用于辅助定位。
然而，MM技术对于环境的要求较高，在有干扰或反射环境下精度会受到影响。
5. GPS/DR/MM组合导航技术为了克服单一定位技术的不足，本文提出了基于GPS/DR/MM组合导航技术的AGV定位系统。
系统首先利用GPS获取初始位置信息，然后通过DR技术计算位移和方向信息，再利用MM技术获取辅助距离信息，最终通过无迹卡尔曼滤波算法融合得到高精度的定位结果。
GPSDR车载组合导航定位系统研究的开题报告
GPSDR车载组合导航定位系统研究的开题报告一、选题背景和意义随着现代社会交通运输的快速发展，车辆导航定位系统成为人们在出门旅行时比较重要的工具之一。
在现代城市中，车辆驾驶人员需要根据导航系统提供的路线规划来完成车辆行驶任务。
因此，车辆导航定位系统的精度、速度和可靠性是车辆驾驶人员选择该系统的重要前提条件。
与此同时，为了满足人们对车辆安全和驾驶体验的需求，车载导航系统功能不断普及和深化，不仅能为车辆驾驶人员提供导航引导功能，而且能提供车辆状态实时监测和智能分析等服务。
现今比较成熟的导航定位技术主要有GPS、GLONASS、BD（北斗）等卫星导航系统。
然而，在城市中心和建筑密集地区，信号延迟、信号干扰和多径效应等导航问题就会多出现，因此这些卫星导航系统的定位精度会受到很大的影响。
因此，发展可靠的车载组合导航定位系统已成为解决城市车辆导航定位精度问题的一个重要途径。
二、研究目的和内容本研究旨在通过对车载组合导航定位系统的分析和研究，提高城市车辆导航定位的精度和可靠性。
具体目的和内容如下：1. 分析车载组合导航定位系统的基本原理和功能，探讨车载组合导航定位系统与传统卫星导航系统的区别和优势；2. 研究车载组合导航定位系统的传感器选择和集成，优选合适的传感器进行组合定位，提高车辆定位精度和稳定性；3. 分析车辆在城市中行驶的特点和定位难度，提出适用的全局和局部定位算法，优化车辆定位效果；4. 开展车载组合导航定位系统的性能测试和数据分析，验证车辆定位效果，为车辆定位系统的实际应用提供参考和指导。
三、研究方法和实现计划本文采用文献调研、理论分析和实验测试相结合的方法进行研究。
实现计划如下：第一阶段：对车载组合导航定位系统的研究和分析。
综合比较不同车载组合导航定位系统的原理和功能，研究车载组合导航定位系统在城市中行驶的定位难度和优化策略。
预计用时2周。
第二阶段：优选传感器进行组合定位。
通过对车载组合导航定位系统的传感器进行选择和集成，提出一种比较适应城市道路的定位方法。
GPS概论第五章GPS卫星定位基本原理PPT课件
线性化后：
i
X ( 0 0)x ii dX Y(0 0)yii dY Z (0 0)zii dZ (0)i NctV RctV S (Vio)niVtrop
x(i0X )i0dX y(i 0)Yi0dY z(i0Z )i0dZ (0)iNctV RctV S (Vio)niVtrop
误差方程为：
• 定义
– 单独利用一台接收机确定待定点在地固坐标系中绝对位 置的方法
• 定位结果－与所用星历同属一坐标系的绝对坐标
– 采用广播星历时属WGS-84
– 采用IGS – International GPS Service精密星历时为 ITRF – International Terrestrial Reference Frames
~ N 0 Int ( ) Fr ( )
• 整周计数 Int
载波相位观测值
• 整周未知数（整周模糊度） N 0
19
载波相位测量的观测方程
原始形式：
(iN i) ictR V ctS V (V i o)in V trop i iN i ictR V ctS V (V i o)in V trop
接收机根据自身 的 钟 在 tR时 刻 所 接 收 到 卫 星 在 tS 时刻所发送信号 的相位
(tS)
tR tS
R
R
理想情况
实际情况
18
载波相位观测值 ti
• 观测值
Fr i Int() i N 0
首次观测：
0 Fr ( ) 0
t0
以后的观测：
Fr 0 N0
i Int ( ) i Fr ( ) i 通常表示为：
载波波长为原来波长的一半，信 号质量较差（信噪比低，降低了 30dB）
基于DSP的车载GPS／DR组合导航系统硬件设计
基于DSP的车载GPS／DR组合导航系统硬件设计2010-03-07 23:38:06 来源：作者：北京市北京理工大学信息科学技术学院杜萌付梦印王美玲针对低成本组合导航技术发展的需要，结合主要传感器特点，本文介绍了以浮点DSPTMS320VC33为组合导航算法实现的核心处理器，利用TL16C554进行通信口扩展的GPS/DR组合导航系统的设计方案，给出了系统硬件的设计方法。
所设计的系统具有体积小、成本低、实时性好、可靠性高、扩展性好等特点，具有广泛的应用价值。
0引言目前，差分GPS水平定位精度已经达到3~5m，完全满足车辆定位精度的要求。
但是，由于在城市高建筑群中或穿过立交桥时，常常会出现GPS信号遮挡问题，导致GPS不能正常定位。
航位推算（DR）是常用的车辆定位技术，但方向传感器随时间积累误差较大，不能单独、长时间地使用。
采用组合导航系统能够利用GPS系统提供的位置和速度信息对DR 系统的误差进行实时的校正和补偿；当GPS信号失锁时，又可通过DR系统完成航位推算，提高了组合导航系统的可靠性。
组合导航系统除了要完成大量运算处理工作外，还要实现惯性测量单元IMU（陀螺仪和加速度计）和GPS等传感器的数据采集、与外部系统的通信、时序逻辑控制和人机接口等功能。
在这种情况下，如果仅用一片DSP芯片，则系统的实时性能较差，因此多数组合系统都采用两个或多个DSP或是由一个或几个通用的微处理器MPU加上一个DSP构成主从式多处理器系统的方案。
而目前利用DSP与FPGA结合的方案来处理高速的数字信号越来越被广泛采用。
1 GPS/DR组合导航系统组成该GPS/DR组合系统具有接收和处理里程计信息、电子罗盘信息、惯性测量单元IMU以及GPS的信息的功能，其系统组成主框图如图1所示。
GPS提供的绝对位置信息可以为DR提供推算定位的初始值并进行误差校正；另一方面，DR的推算结果可以用于补偿部分GPS定位中的随机误差，从而平滑定位轨迹。
位置-姿态并行滤波的DR／GPS组合导航算法
ａ ａ ｔ ｅｙＳ ｍｕ ａｉ ｎ ｒ ｓ ｌ ｎ ｉ ａｅ ａｌ ｓ ｎ ｏ ｓ ｎｏ ｍａｉ ｎ ｃ ｎ ｂ ｓ ｄ ｅ ｅ ｔ ｅｙ ａ ｄ ｇｗ ｅ ｆ ｃ ｅ ｕ ｔ ｄ ｐ ｉ ｌ ． ｉ ｌｔ ｕ ｔ ｉ ｄ ｃ ｔ １ ｅ ｓ ｒ ’ｉ ｆｒ ｔ ａ ｅ ｕ ｅ ｆ ｃｉ ｌ ． ｎ ｌ ｐ ｒｅ ｔ ｒ ｓ ｌ． ｖ ｏ ｅ ｓ ｏ ｖ Ｋｅ ｗｏ ｄ ： ｄ ａ ｅ ｋ ｎ ｎ ＧＰ ｉ ｔｇ ａｅ ａ ｉａｉ ｎ ｓ ｓｅ ， ＫＦ ｙ ｒｓ ｅ ｄ ｒ ｃ ｏ ｉｇ， Ｓ， ｅ ｒ ｔ ｄ ｎ ｖｇ ｔ ｙ ｔ ｍ Ｅ ｎ ｏ
驶时车体的俯仰对航 向角的测量影 响不可忽视 。 本文就如何利
用 低 成 本 的 Ｄ 和 Ｇ ｓ进行 姿 态 、 置 组 合 进 行 了研 究 ， 卡 Ｒ Ｐ 位 以
系统 最 终 的定 位结 果 ： 当 Ｇ Ｓ接 收 机 受 到 屏 蔽 不 能 正 常 工 作 Ｐ 时 ． 导航 系统 仍 然 能 通 过 推 算 提 供 导 航 信 息 。 主
本 文 滤 波 器 采 用 位置 、角 度 分别 滤波 的并 联 滤 波 器 结 构 。
一
和Ｄ Ｒ的导航参数信息得 出定位结果 ， 一旦 Ｇ Ｓ失效航位 推算 Ｐ
般 来 说 １ 的 采样 频 率 可 以满 足位 置 对 数 据 更 新 率 的 要 求 ， Ｈｚ 同时 为 避 免 量 测相 关 问题 要 求 位 置 滤 波 周 期 要 大 于 Ｇ Ｓ的 位 Ｐ 置时 间 相 关 常 数 ， 因此 采 用 位 置 、 角速 度 并 行 滤 波方 式 ， 置 子 位 滤波 器 以较 长 的滤 波周 期 处 理 位 置数 据 ， 度 子 滤 波 器 以较 短 角 的周 期 处 理 姿 态 角 数 据 ， 既满 足 了位 置 和 角 度 对 滤 波 周 期 要
第五章 GPS-DR组合导航
（2）传感器数据的集中处理导致滤波器的 容错性能较差。当一种传感器的数据出现 较大偏差时,该错误将会被传播到所有观 测量和状态变量的估计中去,导致状态污 染,滤波精度和稳定度下降。
分散式滤波技术就是为了解决集中式kalman滤 波器的上述缺陷而提出的, 它将单独的Kalman滤波 器用一个主滤波器和一组局部滤波器来代替,相应 的数据处理过程也分为两个阶段。在第一阶段中, 每个传感器的信息被送入对应的局部滤波器中处理, 产生局部最优状态估计;在第二阶段,主滤波器将局 部滤波器输出的局部状态估计进行融合处理,并产 生最终的全局状态最优估计。在分散滤波过程中, 由于不同传感器的数据被单独和并行处理,因而减 少了计算量,计算效率也大大提高。
第五章
GPS/DR组合导航
5.1 GPS/DR组合方法简介 5.2 联邦滤波算法
5.1 GPS/DR组合方法简介
GPS定位的方法在车辆定位与导航中应用 日趋广泛,但是由于GPS容易受到外界环境的 干扰,尤其是在高楼林立的城市,或者车辆通 过隧道及立交桥时,GPS 卫星信号将很差甚 至中断而无法定位。要得到连续可靠的定位 信息就需要其他的辅助手段。DR是典型的独 立定位技术,在短时间内能够保持较高的精 度,且其有效性不受外界影响,但该方法仅能 确定相对位臵,且误差将随推算过程而累加。
利用kalman滤波实现多个传感器的信 息融合有两种途径:一种是标准的集中式 kalman滤波,另一种是分散式kalman滤波。 采用集中式kalman滤波,理论上可以获得 系统状态的最优估计,但是在实际应用中 存在着以下缺陷:
（1）采用严格最优估计的方法对系统所有 的测量量进行集中处理,系统状态维数高, 计算负担重,严重影响了滤波器的动态性 能和实时性。
因此,GPS和DR存在很强的互补关系。 一方面,GPS提供的绝对位臵信息可以为 DR提供推算定位的初始值并进行误差校正; 另一方面,DR的推算结果可用于补偿部分 GPS定位中的随机误差,从而平滑定位轨迹。 所以,利用适当的方法将两种系统组合起 来,充分利用其定位信息的互补性,就能够 获得比单独使用任何一种方法时都要高的 定位精度和可靠性。
AGV用GPS-DR组合导航信息融合
2011年1月第27卷第1期 沈阳建筑大学学报(自然科学版)Jo urnal o f Shenyang Jianzhu U n i v ersit y (N atura l Sc i ence)Jan. 2011V o l .27,N o.1收稿日期:2010-09-20基金项目:辽宁省自然科学基金项目(20072009)作者简介:张晓霞(1959 ),女,教授,博士,主要从事高温材料性能、结构分析研究.文章编号:1671-2021(2011)01-0173-05AGV 用GPS/DR 组合导航信息融合张晓霞,汪传龙,韩刘柱,李晓琳(沈阳建筑大学交通与机械工程学院,辽宁沈阳110168)摘 要:目的研究一种满足室外自动导引小车(AGV )导航要求的高精度、低成本的组合导航系统.方法应用信息融合技术,通过航位推算系统辅助GPS 定位,并采用卡尔曼滤波的融合算法,克服了GPS 信号的遮蔽与中断问题,使组合系统能够较好地满足AGV 导航定位的需要.用VC++编写融合算法以及实验控制程序,实现了实验数据的采集以及对AGV 的运动控制.结果给出了GPS 单独导航和GPS /DR 组合导航两种工作状态下的位置误差.从对比中可以看出,组合导航系统的定位精度比GPS 单独导航的定位精度提高了50%.结论组合导航系统可以减小甚至消除推算定位系统随时间积累的误差,并在任何情况下能较好地实现AGV 的实时、可靠、准确定位.关键词:信息融合;AGV;定位技术;GPS /DR 组合定位;卡尔曼滤波中图分类号:V 249 32+8 文献标志码:AOn the GPS /DR Integrated Navigati on Syste m for AGVZHANG X iaoxi a,WANG Chuan l ong,HAN L i uzhu,LI X iao li n(Schoo l o f T raff i c and M echan ica l Eng i neering,Shenyang Jianzhu U niver sit y,Shenyang,Ch i na ,110168)Abst ract :A GPS /DR i n tegra ted nav igati o n sy ste m is i n vestigated to m ee t the outdoo r auto m ati c gui d ed ve h icle(AGV )nav i g ation require m ents such a s h igh accuracy and l o w co s.t In t h is paper ,the Dead Reckon i n g Sy ste m is assisted w ith the GPS po siti o n,and the proble m o f GPS si g nal shie l d i n g and i n terrupti n g is over com e through the Ka l m an F ilter .B y tak i n g full adv antages o f the i n for m a ti o n fusi o n theory ,the i n teg rated syste m can be w e ll satisfi e d w ith the de m ands o fAGV nav igation o rienta ti o n.M o reo ver ,the AGV m ov e m en t contro l and experi m enta l data acquisition are obta i n ed by usi n g VC++fusi o n and experi m en tal contro l pro gra m.The nav igation po sitioning erro rs o f t h e GPS and i n tegra ted G PS /DR w ere co m puted as w e l.l The po sitioning accuracy o f the integ rated nav i g a ti o n sy ste m increases by 50%in com parison w ith t h at of t h e G PS nav i g ation a l o ne .Therefo re ,the i n teg rated nav igation can actua lize rea l ti m e ,credible and ex act AGV po si ti o n i n g w ith a m i n i m um position i n g erro r ,and decrease or eli m i n ate t h e reckon i n g po siti o n i n g sy ste m erro r accum ulated w ith ti m e .K ey w ords :infor m ati o n fusion;AGV;po sitioning techno logy ;integ rated G PS /DR nav igation ;ka l m an filter 全球定位系统(G PS)可以提供全天候、连续、实时的高精度定位信息,而且其具有误差不随时间累积、使用成本低等优点,因此在车辆导航系统中被普遍采用.但是GPS 接收机在城市中受到高大建筑物、桥梁、隧道、树木等的遮挡时,会引起信号的失锁,此时就不能够为用户提供导航服务.174 沈阳建筑大学学报(自然科学版)第27卷DR(D ead-R eckoning )是一种常用车辆导航定位技术,它通过一个方向传感器和一个速度传感器推算出车辆的瞬时位移增量,在用户初始位置已知的情况下求解出用户的位置.由于方向传感器的误差随着时间的延长而积累,所以DR 不能够单独、长时间为用户提供导航服务.因此将G PS 与DR 组合,是一种比较理想的组合导航方式.在车辆GPS /DR 组合定位系统中,卡尔曼滤波是应用最为广泛的数据融合算法[1-4].K a l m an 滤波方法用于G PS /DR 组合定位中,就是将G PS 和DR 的信息同时用于定位解的求解过程中,使DR 系统的状态在滤波过程中不断得到修正,组合定位的输出又可以提供较为准确的初始位置和方向信息,从而即使在G PS 失效,单独使用DR 推算定位时也能长时间保持较高精度,同时利用K a l m an 滤波可以有效地消除G PS 和DR 传感器定位测量中的随机误差,系统的可靠性得到了提高[5-10].目前国内外学者对室外AGV 的导引技术的研究还比较欠缺,因此笔者利用GPS /DR 组合导航系统和卡尔曼滤波数据融合算法的优点,应用到室外AGV 定位导引技术中,结果使AGV 定位精度比G PS 单独定位精度提高58 3%,同时使AGV 能够适应室外大范围的作业.1 G PS /DR 组合导航的卡尔曼滤波器定位设计在组合导航系统中采用多传感器信息融合技术可以扩展整个系统的时间和空间覆盖率,增加系统的信息利用率,提高融合数据的置信度和精度,增强系统的容错性和可靠性.卡尔曼滤波器是一个最优和高效的传感器数据融合技术.卡尔曼滤波器应用于AGV 定位将GPS /DR 导航组合的定位问题陈述为传感器数据融合问题.本系统G PS /DR 信息融合结构如图1所示.图1 G P /DR 信息融合结构图F ig 1 G P /D R i nfo r m ati on fusi on structure2 G PS /DR 组合卡尔曼滤波器定位技术的信息融合2 1 里程计位姿估计模型简介2 1 1 差动驱动AGV 的里程计位姿估计模型对平面移动的差动驱动AGV 车体,导航应用要求AGV 车体的位置和姿态(简称位姿).在AGV 运动平面上建立的现场坐标下,可以用以下向量表示p =[x y ]T.(1)式中:x,y 为AGV 在现场坐标系下xy 平面的位置; 为AGV 车体在现场坐标系下对x 轴的姿态角度.对于差动驱动的AGV 来说,后续位姿可以依据初始位置和姿态,依据两个驱动车轮的行进路程推算得出.对具有固定采样间隔 t 的离散系统,行走距离的增量( x, y, )为x = s co s( + /2),(2) y = s si n ( + /2),(3) = s r - s lb ,(4) s=s r + s l2.(5)式中: s l , s r 分别为采样间隔时间内左右轮行走的距离;b 为差动驱动AGV 两个轮子之间的距离.位置更新进一步得到AGV 位姿更新的基本方程:p =f(x,y, , s r , s l ).(6)2 1 2 差动驱动AGV 的里程计位姿估计误差模型在误差模型的建立中,主要考虑了差动驱动AGV 两个驱动轮行走距离引入的误差.并且假设AGV 在初始的位姿协方差矩阵 p 为已知.对运动增量( s r , s l ),假定协方差矩阵 为=co v ar ( s r , s l )=k r | s r |00k l | s l|.(7)式中: s r , s l 为各轮行走的距离,k r 和k l 为误差系数,代表马达驱动和轮子地面交互的非确定性参数,其值可以通过实验取得.本实验编码器误差系数为0 1~0 3.假定采样周期前一时刻位姿p 与 s rl =( s r , s l )不相关,对式(6)线性化(一阶泰勒展第27卷张晓霞等:AG V用G PS/D R组合导航信息融合175开)后利用误差传播定律有[11-14]P = p f p p f T+rl frlf T.(8)式中: p为前一步 p 给定.2 2 G PS/DR组合导航的卡尔曼滤波器定位(1)AGV位置预测根据AGV老位姿(在时间步k)和由于控制输入u(k)产生的运动,通过DR系统预测AGV 在时间步k+1的位姿和预测误差方差阵p^(k+1|k)=f(p^(k|k),u(k)),(9)p(k+1|k)= p f p(k|k) p f T+ u f u(k) u f T.(10)由差动驱动的AGV,式(9)可以由式(6)推导得出,其中u(k)= s r l=( s r, s l).(2)观测(量测值)G PS输出的是以经纬度为坐标的协议地球参考系(W GS-84),坐标原点在地球质心,为了便于使用,需要进行高斯-克吕格投影计算,转化为平面直角坐标系.如果将G PS接收机看作AGV的一个位姿传感器,那么输出的导航定位数据就是AGV的位姿的一组观测数据.在时刻k+1得到GPS输出的AGV的位姿数据z(k+1)及其协方差 R(k+1).即:z(k+1)=(x G PS y G PS GPS)T,(11)R(k+1)= 2xG PS xyG PS0yxGPS yG PS000GPS.(12)由于GPS解算位置和解算速度采用不同原理,故其位姿方差阵中姿态角与位置不相关.(3)GPS接收机输出数据有效性的判断在G PS/DR导航组合中,G PS的观测值序列的位置数据易出现大的突变和跳跃(其中某些观测数据无效);转化后的GPS输出坐标首先利用阈值法根据机器人里程计的定位数据剔除野值,阈值的选取可以根据实验观测数据来设定.通过DR系统在短时间和短范围内具有较高的位姿的精度,在到达新的位置后,依据M aha l a nobis距离来确立门限判断GPS数据的有效性.针对G PS输出的定位数据和速度数据的非相关性,分别计算G PS到DR的位置和姿态M ahalanobis距离r xy(k)、r (k)计算如下:2r xy(k)2=(X GPS(k)-X0(k))T( 0(k)+G PS(k+1))-1(X GPS(k)-X0(k)),(13)XDR(k)=(xDR(k),yDR(k))T,(14)D R(k)=xD R(k)2 xyDR(k)xyDR(k) yDR(k)2,(15)G PS(k)=xG PS(k)200 yG PS(k)2,(16) 2r DR(k)2=( GPS(k)- D R(k))T( DR(k)2+ G PS(k)2)-1( G PS(k)- DR(k)).(17)式中:X DR(k), D R(k), DR(k), DR(k)为DR的位置和姿态数据以及方差误差;X GPS(k), G PS(k), G PS(k), G PS(k)为G PS接收机输出的位置和航向转角数据及误差.根据试验确定M aha lanob is距离的门限值[11],通常情况下位置M aha lanob is距离门限值r xy th=1 2,位置M aha lanob is距离门限值r th=1 6[12-15].当计算得到的马氏距离大于阈值时,将G PS接收机输出数据视为错误值舍去;小于阈值则加以利用.分别判断G PS位置和姿态,修正G PS位姿如下:a.r xy(k) r xy th当r (k) r th时,说明GPS接收机的位置数据和航向角数据均有效.p GPS(k)=[x GPS(k),y G PS(k), G PS(k)],(18) GPS(k)=2xGPS(k)000 2yG PS(k)000 2 GPS(k).(19)当r (k)>r th时,说明GPS接收机的位置数据有效,航向角数据无效,式中:G PS(k)=0, G PS=0.b.r xy(k)>r xy th当r (k) r th说明G PS接收机的位置数据无效,航向角数据有效:p GPS(k)=[0,0, G PS(k)],(20)GPS(k)=00000000 2 G PS(k).(21)当r (k)>r th说明G PS接收机的位置和航向角数据均无效,式中: G PS(k)=0, G PS=0.(4)测量预测和匹配通过DR系统的位置预测,直接得到了AGV 导航定位的位姿预测z^(k+1).176沈阳建筑大学学报(自然科学版)第27卷^z(k+1)=H(k+1) p^(k+1|k).(22)式中:H(k+1)=I(单位阵).在G PS/DR导航组合中,DR系统的数据采集和GPS导航数据的采集在时间上保持同步,所以认为G PS观测位姿在z(k+1)和DR系统的测量预测^z(k+1)是匹配的.从配对的G PS观测位姿z(k+1)和DR系统的测量预测^z(k+1)可以计算修正v(k+1).v(k+1)=z(k+1)-^z(k+1).(23)修正的协方差 I N(k+1)可以通过误差传播率求得:I N(k+1)=H(k+1) p(k+1|k)H T(k+1)+ R(k+1).(24)(5)卡尔曼滤波位姿估计对G PS输出的位姿数据作判断和修正后,得到了相对可靠的位姿数据.接下来根据DR的位置预测和在k+1时刻的GPS观测,计算AGV位姿的最佳估计p^(k+1|k+1).卡尔曼滤波位姿估计的增益矩阵:K(k+1)= p(k+1|k) H(k+1) -1I N(k+1).(25)卡尔曼滤波位姿估计:p^(k+1|k+1)=p^(k+1|k+1)+K(k+ 1) v(k+1).(26)卡尔曼滤波位姿方差估计:p(k+1|k+1)= p(k+1|k)-K(k+ 1) I N(k+1) K T(k+1).(27)以上各式实现了GPS/DR导航组合的卡尔曼滤波位姿估计和方差更新.3 G PS/DR组合导航试验为了验证笔者所设计的定位方法的定位精度和有效性,以博创旅行家II型轮式移动机器人为平台,在沈阳建筑大学进行了实验.由于受到G PS 差分信号转发范围的限制,实验在足球场上进行.令AGV行走100m,时速为0 2m/s.导航定位结果如图2~5所示.图2和图3中分别给出了AGV实际运行轨迹线,GPS单独滤波和GPS/DR 组合滤波的变化曲线.比较图2和图3可知,G PS 单独滤波定位精度为1 2m,采用基于卡尔曼滤波的GPS/DR数据融合后,定位精度为0 5m,比GPS单独滤波定位精度提高了58 3%.并且输出轨迹的平顺性有一定提高.图2 G PS单独滤波曲线图F ig 2 F ilter curve o fG PS a l one图3 G P S/DR组合滤波曲线图F i g 3G P S/DR com b i nati on filter curve s图4和图5分别给出了沿直线运动的AGV 姿态角在融合前后的效果.图4 G PS原始数据AGV姿态角F i g 4 AG V attitude ang les based o n the raw G PS da ta图5 G PS/DR数据融合以后AG V姿态角F i g 5 AG V attitude ang les after G PS/DR da t a fusi o n 比较图4和图5可见,通过数据融合以后姿态角有了明显的改善,但是融合以后的姿态角仍然有一定偏差(准确偏差为0).存在偏差的原因是G PS的姿态角是由GPS输出的运动速度数据第27卷张晓霞等:AG V用G PS/D R组合导航信息融合177转换得到,同时G PS数据本身就存在一定偏差,故姿态角必然存在偏差.但采用更高精度的G PS 接收机可以进一步减小偏差.4 结 论试验结果表明,AGV用GPS/DR组合导航系统是一种高精度的实时导航系统.在该系统中,采用低成本的航位推算DR传感器辅助GPS定位,克服了GPS单独使用时因信号中断而引起的系统失效,具有较高的性价比.同时笔者利用DR 数据,依据M ahalanobis距离来确立门限值以判断G PS数据.提高了系统中G PS数据的有效性,也就提高了系统的精度.参考文献:[1] 张男,王莹,张尔扬.G PS/I N S组合导航系统设计及实现方案[J].遥感技术与应用,2004,17(2):70-72.(Z hang N an,W ang Y i ng,Z hang E ry ang.The desi g n and rea liz i ng sche m e o f G PS/I N S com bi ned nav igati on sy ste m[J].R e m o te Sensi ng T echno l o gy andA ppli ca tion,2004,17(2):70-72.)[2] 刘巍巍,赵红.遗传算法在自动化立体仓库路径调度问题中的应用[J].沈阳建筑大学学报:自然科学版,2008,30(3):339-340,360.(L iuW ei w e,i Z hao H ong.A ppli ca tion o f geneti c a l go r it hm i n pa t h scheduli ng o f autom a ted w areho us e[J].J o urnal o f Shenyang Jianzhu U niversity:N a tura lSc ience,2008,30(3):339-340.)[3] W h itaker W R.Po siti on and o rien tati on da t a fo r autonom ous nav i ga ti on[J].G PS W o rld,2006(9):71-75.[4] H iroka w a R,Sato K,Is h i hara R,et a.l T hread i ng them aze G P S/I N S,l and m ark s ensi ng and ob stac l e avo i dance[J].G PS W o rd,2004(11):20-27.[5] M aughan F G,L e w isH J.AGV co ntro lled FM S[J].A S HRA E T ran s ac ti ons,2003,109(1):27-35.[6] M i chi ko W,M asash i F.Inte lli g ent AGV driv i ng tow ard an autonom ous decen trali zed m anufacturi ngsy ste m[J].R o bo tics and C om puter Integ ra ted M anufac t ur i ng,2001,17(2):57-64.[7] K o ch K R,Y ang Y.R obust K al m an filt e r fo r rankdefic i ent o bserv ati o n m ode ls[J].Jo urnal o f G eo desy,1998,72:7-8.[8] 徐景硕,秦永元,彭蓉.自适应卡尔曼滤波器渐消因子选取方法研究[J].系统工程与电子技术,2004,26(11):1552-1554.(X u Ji ng s huo,Q i n Y ongy uan,P eng R ong.N ewm e t hod fo r se l ec ting adapti v e ka l m an f ilter fadi ngfac t o r[J].Sy stem s Eng i neer i ng and E l ec tron ics,2004,26(11):1552-1554.)[9] 万德钧,房建成,王庆.G P S动态滤波的理论、方法及其应用[M].南京:江苏科学技术出版社,2000:73-80.(W an D ejun,F ang Jiancheng,W ang Q i ng.T heory and m e t hod o f G P S dyna m ic filteri ng and its appli cati on[M].N an ji ng:Jiang su Sc ience and T echno l o gyPub lish i ng H o us e,2000:73-80.)[10]许丽佳,陈阳舟,崔平远.G PS/IN S组合导航系统中的信息融合算法研究[J].计算机仿真,2004,21(5):20-23.(X u L iji a,C hen Y ang zhou,Cu i P i ngyuan.S tudy o ni nfo r m ati on fusi on techno l o gy i n G PS/I N S i n teg ratednav iga tion sy st em[J].C om put e r S i m ul a ti on,2004,21(5):20-23.)[11]Sun S L.M ulti sen s o r op ti m a l i nfo r m ati on fusi o nK a l m an filter w it h applicati o n[J].A ero space Sc ience and T echno l o gy,2004,8(1):57-62.[12]M o ham ed A H,Schw a rz K P.A dap tive kal m an f ilter i ng fo r I N S/G PS[J].Journa l of G eodesy,1999,73(4):1024-1030.[13]史忠科.最优估计的计算方法[M].北京:科学出版社,2001.(Shi Z hongke.C alculati on o f opti m al esti m ati o n [M].B e ijing:Sc i ence Publis h i ng Ho use,2001.) [14]武汉大学测绘学院测量平差学科组.误差理论与测量平差基础[M].武汉:武汉大学出版社,2003.(Survey ing and M appi ng R esearch G ro up o f W uhanU niver sity.Erro r t heo ry and fo undati on o f surv ey i ngad j ust m ent[M].W uhan:W uhan U niversity P re ss,2003.)[15]C o llier M.A m i cro AG V fo r f l ex ible m anufacturi ngi n s m a ll enterpr ises[J].Integ ra ted M anufacturi ngSy ste m s,2003,14(5):442-448.。
2019GPS第五章-PPT精选文档
GPS星座示意图
GPS卫星基本功能 ：
——接收和储存由地面监控站发来的跟踪监 测信息； ——受地面监控站的指令，调整卫星姿态和 启用备用卫星；
——进行必要的数据处理工作； ——通过星载的高精度原子钟提供精密的标 准时间； ——向用户广播GPS信号。
二、地面监控部分
• 地面监控系统：由一个主控站、三个注入站 和五个监测站 组 成。 • 主控站作用： 收集各个监测站所测观测值、环境要素等数据 ，计算每颗GPS卫星的星历、时钟改正量、状态数据、以及信号 的大气层传播改正，并按一定的形式编制成导航电文，传送到 主控站：此外还控制和监视其余站的工作情况并管理调度GPS卫 星。 • 注入站作用： 将主控站传来的导航电文，分别注入到相应的 GPS卫星中，通过卫星将导航电文传递给地面上的广大用户。 • 导航电文： GPS 用户所需要的一项重要信息，通过导航电 文能确定GPS卫星在各时刻的具体位置。
d) 操作简便：GPS测量自动化程度很高，操作员的主要任务只 是安置并开关仪器，量取仪器高，监视仪器的工作状态等 。接收机自动完成观测工作，如卫星捕获，跟踪观测和记 录等。GPS数据处理也由软件自动完成。
e) 全天候作业：GPS接收机可以在任何地点(卫星信号不被遮 挡的情况下)，任何时间连续地进行，一般也不受天气状况 的影响。
• •
GPS卫星
相对于经典的测量技术来说，这一新技术的主要特点 如下：
a) 测站之间无需通视：因而不再需要建造觇标，可减少测量 工作经费和时间，同时也使点位的选择变得甚为灵活。
b) 高精度三维定位：GPS可以精确测定测站的平面位置和大地 高。 c) 观测时间短：快速静态相对定位法，观测时间可少至数分钟 ；实时动态定位(RTK) 可提供厘米级的实时三维定位。
无人机结构与系统课件：组合导航系统
利用多种导航卫星信号有利于误差补偿提高导航定位的精 度和可靠性。
► 系统误差——轨道系统误差、卫星钟差、多路径误 差…；
► 随机误差——信号随机误差、轨道随机误差、钟差随 机误差…;
► 有色噪声——太阳光压、随时间变化的钟差…; ► 异常误差——周跳、变轨误差…。
➢ 此外，因为没有GLONASS卫星的精确轨道源数据， 故无法测定精度。与GPS相比这是GLONASS的个一 主要缺陷。
3）GALILEO存在的主要问题
➢ “伽利略计划”是由欧盟委员会和欧洲空间局共同发起并 组织实施的欧洲民用卫星导航计划，它受多个国家政策和 利益的制约，政策具有摇摆性。
➢ 由于欧盟受美国的影响极大，“伽利略计划”本身的独立 性值得怀疑；
的容错功能。 ➢ 提高导航系统的抗干扰能力，提高完好性。
（4）多传感器组合导航系统
多传感器组合导航系统是指传感器数目多于两个的组合导 航系统，GPS／INS／Loran-C、GPS／Glonass／INS、 GPS／JTIDS／INS等都是实用的例子。在不少应用场合 传感器数目可能大于等于4个，例如GPS／INS／ DNS/Loran-C和GPS／INS/JTIDS/TAN／SAR等。 优点： • 实时性好、容错性强和精度高。 • 未来发展趋势。
组合导航系统
全球卫星导航定位系统（GPS、 GLONASS、GALILEO、BD）
惯性导航（包括惯性导航INS、航位推
现
算导航DR）
有
导 航
天文导航系统（CNS）
系
统
重磁导航（重力导航、磁力导航）
匹配导航（地形匹配导航、影像匹配导 航）
1.卫星导航存在的问题
1）美国GPS可能存在问题
车载GPSDR组合导航系统的DR算法
车载GPSDR组合导航系统的DR算法摘要：随着城市交通道路系统的日益复杂，人们对车辆定位精度的要求也越来越高。
传统的车辆导航系统采用GPS（全球卫星导航系统）技术对车辆进行定位，但在现代大都市环境中，由于树木、立交桥、楼群的遮掩，GPS 信号会经常出现失锁和多径效应，导致其定位精度大大降低。
而航位推算技术（DR）有较强的独立性，同GPS 定位技术形成较强的互补。
因此对导航系统的DR算法的研究很有必要。
关键词：航位推算加速度计陀螺仪0 引言随着经济发展，汽车普及率越来越高，道路四通八达，城市间的交流日益频繁，人们活动范围不断增大。
在人们游玩休闲、工作出行场所都已经不限于在自己熟悉的地域里，加上各种立交桥、环岛、隧道、高速公路的修建，在行车到丛林山区时，不熟悉路线，找不到方位和目的地的情况屡见不鲜，车载导航系统以可接受的价位成为随车基本配备。
GPS系统是当今世界使用最广泛的卫星导航定位系统，无疑成为导航系统的核心。
但GPS系统存在易受干扰、动态环境中可靠性差以及数据输出频率低等不足，因此GPS/DR组合导航系统[1]无疑是在提高导航信息的精准度方面的一个途径，特别在无GPS信号和GPS信号微弱不足以提高导航数据时，DR运行，当然也可以是GPS和DR一起运行，因为DR完全自主，保密性强，并且机动灵活，具备多功能参数输出，但是存在误差随时间迅速积累的问题，导航精度随时间而发散，不能单独长时间工作，必须GPS不断加以校准，GPS和DR两者取长补短，构成一个整体。
本文主要介绍车载GPS/DR 组合导航系统[2]中的DR算法。
1 航位推算技术航位推算技术[3]（Dead Reckoning简称DR）是一种传统的跟踪导航算法，在获知载体当前时刻坐标位置的前提下，通过惯导元件取得的单位采样周期内载体移动的转向角和距离，进而可以推算出其在下一时刻的坐标位置。
由此可见，获得载体的行驶速度和相对转角后，就可以通过航位推算算法计算出该载体的坐标位置。
GPSDR车辆组合导航系统设计与研究的开题报告
GPSDR车辆组合导航系统设计与研究的开题报告一、选题背景随着车辆组合导航系统的应用不断普及和发展，越来越多的车辆导航系统需要具备高精度、高可靠性、高精确度的定位和导航能力。
为此，全球卫星定位系统（GPS）是一种被广泛应用于车辆导航系统中的技术。
然而，由于GPS在城市峡谷、高楼大厦等复杂环境下的信号遮挡、反射、多径效应和干扰等问题，导致其定位精度和可靠性受到了很大影响。
为了解决上述问题，GPSDR（GPS Differential Ranging）车辆组合导航系统应运而生。
GPSDR车辆组合导航系统使用多种传感器（如惯性测量单元、测距仪、捷联惯性组合导航系统等）来融合GPS信号，以提高车辆导航系统的定位精度和可靠性。
通过进行精确的数据处理和算法优化，GPSDR车辆组合导航系统可以实现高达厘米级的定位精度和可靠性，满足越来越多车辆导航应用的需求。
二、选题意义和目的本研究旨在设计和研究GPSDR车辆组合导航系统，解决传统GPS定位存在的问题，并提高车辆导航系统的定位精度和可靠性，以满足更多实际应用需求。
具体实现以下目标：1.设计和实现GPSDR车辆组合导航系统，实现GPS信号和多种传感器数据的融合，以提高定位精度和可靠性。
2.分析GPSDR车辆组合导航系统的算法原理，提出优化方案，以实现更高的定位精度和可靠性。
3.通过实验和测试验证GPSDR车辆组合导航系统的定位精度和可靠性，并与传统GPS定位进行对比分析，以评估其性能优劣。
三、研究思路和方法本研究的思路和方法主要包括以下几个方面：1.基础理论研究。
对GPS、惯性测量单元、测距仪、捷联惯性组合导航系统等传感器进行深入的理论研究，掌握其工作原理、特点和优缺点。
2.系统设计和开发。
基于上述传感器开发GPSDR车辆组合导航系统，实现GPS信号和多种传感器数据的融合，并实现高精度、高可靠性的定位和导航。
3.算法研究和优化。
对GPSDR车辆组合导航系统的算法进行分析和研究，并提出优化方案，以提高定位精度和可靠性。
GPSDR车辆组合导航定位系统关键理论问题的研究的开题报告
GPSDR车辆组合导航定位系统关键理论问题的研究的开题报告尊敬的评委老师：本文选题为“GPSDR车辆组合导航定位系统关键理论问题的研究”，该选题源于现代车辆组合导航技术发展的需求。
目前GPSDR（Global Positioning System and Dead Reckoning）组合导航技术已经广泛应用于航空、海洋、陆地等领域，能够为行驶中的车辆提供高精度的导航和定位服务，但同时存在着一定的误差。
因此，研究车辆组合导航定位系统关键理论问题，是提高导航定位精度，保证车辆行驶安全所必须的。
本文的主要研究内容包括以下方面：1. GPSDR组合导航原理及技术介绍GPSDR组合导航技术的基本原理，以及GPS、DR（Dead Reckoning）技术的组合运用，分析其优缺点。
2. GPSDR组合导航误差分析对GPSDR组合导航过程中可能出现的误差进行分析和探讨，包括GPS定位误差、DR计算误差、传感器误差等。
3. 数据融合算法研究针对GPSDR组合导航过程中的误差问题，提出一种高效、精确的数据融合算法，将GPS、DR和传感器数据进行融合，以提高定位精度和稳定性。
4. 车辆组合导航定位仿真系统设计与实现基于研究出的GPSDR组合导航数据融合算法，设计并实现一套车辆组合导航定位仿真系统，在实际行驶中验证算法的有效性，并对结果进行分析。
综上所述，本文拟通过对GPSDR车辆组合导航定位系统关键理论问题的深入研究，提高车辆导航定位精度与稳定性，保证车辆行驶安全。
同时，研究成果还可为其它领域的组合导航技术发展提供借鉴和参考。
感谢评委老师批准本文选题。
本文将按照科学规范的要求认真开展研究工作，并在所需的时间内提交完成的论文。
智能网联汽车导航定位系统
GPS定位时要求接收机至少观测到4颗卫星的距离观测值才能 同时确定出用户所在空间位置及接收机时钟差
2023/11/11
5.2.1 GPS的组成与原理——特点
（1）全球全天候定位：因为GPS卫星数目较多，且分布均匀， 保证了地球上任何地方任何时间至少可以同时观测到4颗GPS 卫星，确保实现全球全天候连续导航定位服务
来补偿修正DR系统的状态，同时滤波之后的输出又能够为DR 系统提供较为准确的初始位置和航向角，从而能够获得比单 独使用任意一种定位方法都更高的定位精度和稳定性
2023/11/11
5.3 北斗卫星导航定位系统
北斗卫星导航定位系统（BDS）：是由中国自行研制开发的区域性有源三维卫 星定位与通信系统，是继美国的GPS、俄罗斯的GLONASS之后第三个成熟的 卫星导航定位系统。北斗卫星导航定位系统致力于向全球用户提供高质量的定 位、导航和授时服务，其建设与发展则遵循开放性、自主性、兼容性、渐进性 这4项原则。
5.2 全球定位系统
全球定位系统（GPS）是由美国国防部建设的基于卫星的无线电导航定位系统。它 能连续为世界各地的陆海空用户提供精确的位置、速度和时间信息，最大优势是覆 盖全球，全天候工作，可以为高动态、高精度平台服务，目前得到普遍应用
2023/11/11
5.2.1 GPS的组成与原理——组成
2023/11/11
5.2.3 GPS/DR组合导航定位系统
2023/11/11
5.2.3 GPS/DR组合导航定位系统
GPS/DR组合导航定位系统由GPS以及电子罗盘、里程计和导 航计算机等组成
GPSDR组合导航的地图匹配算法研究与实现的开题报告
GPSDR组合导航的地图匹配算法研究与实现的开题报告一、选题背景和意义GPSDR（Global Positioning System and Dead Reckoning）组合导航技术是一种基于GPS和惯性导航技术的导航方式，它通过GPS测量和车辆自身惯性测量信息的融合，提高了在城市峡谷、隧道等GPS信号不良或无法接收的区域的导航精度和稳定性。
地图匹配是GPSDR组合导航中的一项重要技术，它主要是通过将GPS测量值与先验地图信息结合，对车辆的实际位置进行匹配，从而提高车辆位置的准确度和稳定性。
因此，GPSDR组合导航地图匹配算法的研究对于提高车辆导航的精准度和可靠性具有重要的意义。
二、研究内容和目标本文拟研究GPSDR组合导航中的地图匹配算法，主要包括以下内容：1. 对GPSDR组合导航系统的原理、基本组成和地图匹配技术进行阐述，分析GPSDR导航技术的优势和不足；2. 对地图匹配算法的数学模型和数据格式进行分析，设计地图匹配算法的基本流程和实现方案；3. 设计并实现GPSDR组合导航地图匹配算法的原型系统，通过实际测试对算法进行验证和评估；4. 在实现的原型系统基础上，对地图匹配算法进行优化升级，提高算法的运算效率和匹配精度。
三、研究方法和计划1. 研究方法：本文主要采用文献综述和实验仿真相结合的方法进行研究。
通过查阅相关文献，分析GPSDR组合导航技术和地图匹配算法的理论基础和发展现状；并通过Matlab等仿真软件，设计实验样本，对地图匹配算法进行验证和测试。
2. 研究计划：第一周：对GPSDR组合导航技术和地图匹配算法进行文献综述和分类整理；第二周：分析GPSDR组合导航技术的原理和地图匹配算法的数学模型；第三周：设计地图匹配算法的基本流程和实现方案，并编写算法代码；第四周：进行仿真实验数据采集和分析，并对地图匹配算法原型系统进行初步验证；第五周：对地图匹配算法进行优化升级，并对优化后的算法进行测试；第六周：整理实验结果，总结GPSDR组合导航地图匹配算法的研究成果，撰写开题报告。
精品课程《GPS原理及应用》课件第5章 GPS卫星导航
利用（2）式解算运动载体的实时点位时，后续点位 的初始坐标值可以依据前一个点位坐标来假定，因 此，关键是要确定第一个点位坐标的初始值，才能 精确求得第一个点位的三维坐标。
5.2.2 伪距差分动态定位
所谓差分动态定位（DGPS）就是用两台 接收机在两个测站上同时测量来自相同GPS 卫星的导航定位信号，用以联合测得动态用户 的精确位置，其中一个测站是位于已知坐标点， 设在该已知点（又称基准点）的GPS信号接 收机，叫做基准接收机。它和安设在运动载体 上的GPS信号接收机（简称动态接收机）同 时测量来自相同GPS卫星的导航定位信号。
基准接收机所测得的三维位置与该点已知值进 行比较，便可获得GPS定位数据的改正值。 如果及时将GPS改正值发送给若干台共视卫 星用户的动态接收机，而改正后者所测得的实 时位置，便叫做实时差分动态定位。
由式（1）可知，基准站R测得至GPS卫星j的 伪距为
5.2.3 动态载波相位差分测量
GPS载波相位测量方位不仅适用于静态 定位，同样也适用于动态定位，并且已取得厘 米级的三维位置精度。 由载波相位观测方程得出动态差分方程：
不仅如此，GPS卫星的入轨运行，还为 大地测量学、地球动力学、地球物理学、天体 力学、载人航天学、全球海洋学和全球气象学 提供了一种高精度和全天候的测量新技术。 GPS在导航领域的应用，有着比GPS静 态定位更广阔的前景，两者相比较，GPS导 航具有：用户多样、速度多变、定位实时、数 据和精度多变等特点。因此，应该依据GPS 动态测量的这些特点，选购适宜的接收机，采 用适当的数据处理方法，以便获得所要求的运 动载体的状态参数的测量精度。
定时有着广泛的应用。从日常生活到航天 发射，从出外步行到航空航海，都离不开定时。 随着使用目的的不同，人们对时间准确度的要 求也不一样。 GPS卫星都安装有4台原子时钟，GPS 时间受美国海军天文台经常性监测。GPS系 统的地面主控站能够以优于±5ns的精度，使 GPS时间和世界协调时之差保持在 以 内。此外，GPS卫星还向用户播发自己的钟 差、钟速和钟漂等时钟参数，加之利用GPS 信号可以测得站址的精确位置，因此，GPS 卫星可以成为一种全球性的用户无限的时间信 号源，用以进行精确的时间比对。
车辆GPS_DR组合导航方法研究_董绪荣
摘 要: 车辆组合导航技术是解决车辆自主定位 (AVL ) 的一个有效途径。 本文介绍了车辆组合导航系统的原理, 建立了采用速度观测量的定常加速度滤波模 型, 实验结果表明车辆组合导航定位系统的精度和可靠性得到很大提高。
关 键 词: GPS; 航位推算; 车辆自动定位; 卡尔曼滤波 中图分类号: TN 967. 1 文献标识码: A
e, n, v e , vn
滤 波
器
示
图 1 组合导航系统结构框图
5 实验结果
为验证本文算法的效果, 设计了相应跑车实 验。车辆围绕一段方形路线行驶 (由 A 点到 E 点) , 在 B - C 段 GPS 信号被遮挡, 在 C - D 段车 辆经过高楼建筑群。 应用本文算法对跑车实验数 据进行处理, 结果见图 2 (组合导航定位结果) 和 图 3 (单纯 GPS 导航定位结果) , 图中坐标单位是 m。
GPS与DR的组合定位
智能交通系统和车载导航课程报告专业方向：测绘工程A方向姓名：***学号：*************A：我感兴趣的方向对我个人来说，我的兴趣应该在具体的实际应用方面，对应到课堂上的内容就是关于导航系统中具体的定位方法那一部分。
B：重要内容a．车载导航系统中信息控制和信息利用的基本原理b．车载导航系统的导航原理c．导航系统的核心算法C：主要难点a.导航数据的实现模型b.导航地图的概念模型和GDF4.0c.导航系统的核心算法D：课堂上应当补充的知识a．关于导航系统较为具体的实际应用b．关于各种导航系统的发展前景和趋势E：对于课程的建议我个人认为，犹豫资源和时间的限制，我们这门课程缺失的主要是实践部分，学了这么多理论知识，可是同学们大多数都没有实际操作过导航仪器，希望能在实际硬件操作方面有所改进。
F：选做题：GPS与DR的组合定位1.单一的GPS定位在车载导航中的现状和缺点对于现如今的车载导航来说，我们运用的主要定位方法还是基于GPS的.在发达国家，运用GPS系统进行汽车自主导航已经是非常成熟。
目前国际上已经形成了日本、欧洲和北美三大市场，日本是汽车导航产品概念的提出者和市场的推广者，经过数年的技术发展和市场推广，产品的技术和工艺日趋成熟，并在产品的技术先进性方面在市场中处领先地位。
以汽车导航系统为例，由于电子地图与消费电子技术的高度发展，再加上智能型运输系统的成熟，使得日本成为目前全球汽车导航系统普及率与市场值最高的国家。
据调查显示，日本的GPS系统车载使用率高达59%，而2000年以来出产的新车中的30%安装了GPS导航系统，目前年销售量维持在几百万套。
2000年日本的汽车导航系统销售值约为670万美元，占全球市场的77.9%，而欧洲与北美分别仅占13.9%与6.9%。
不过2004年后，随着汽车导航系统的日渐普及，欧洲与北美的市场将成长至710万美元与590万美元，各占市场比例的27%与22.5%，而日本市场则因为普及率高使成长率逐渐趋缓。
- 1、下载文档前请自行甄别文档内容的完整性，平台不提供额外的编辑、内容补充、找答案等附加服务。
- 2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
- 3、如文档侵犯您的权益，请联系客服反馈,我们会尽快为您处理(人工客服工作时间：9:00-18:30)。
与此同时,局部滤波器的存在也使整个多传感器 融合系统的容错能力有所 提高。分散滤波理论已经 发展了20多年,Person，Speyer， Willsky,Bierman,Kerr, Carlson等人先后对其进行 了改进和提高。在所有这些分散滤波方法中,由 Carlson 提出的联邦滤波器以其设计的灵活性、计 算量小和容错性好而受到了广泛重视。目前利用联 邦式滤波器实现多传感器信息融合已成为国际上导 航和制导技术领域内的一个研究重点,并被美国空军 列入其发展新一代容错导航系统的"公共Kalman滤波 器"计划。
另外,DR所需要的初始信息由前一时 刻的有效GPS数据提供,这使得GPS数据中 的误差被直接传播到了DR推算的结果中, 造成DR系统的定位精度下降,从而缩短了 其能够满足定位精度要求的有效工作时间。 另外,该方法只能解决卫星遮挡问题,而对 于其他原因如多径效应等造成的GPS定位 误差则无能为力。
kalman滤波方法用于GPS/DR的组合定 位中,就是将GPS和DR的信息同时用于定位 解的求解过程中,使DR系统的状态在滤波 过程中不断得到修正,组合定位的输出又 可以提供较为准确的初始位臵和方向信息, 从而,即使在GPS失效、单独使用DR推算定 位时也能长时间保持较高的定位精度。第来自章GPS/DR组合导航
5.1 GPS/DR组合方法简介 5.2 联邦滤波算法
5.1 GPS/DR组合方法简介
GPS定位的方法在车辆定位与导航中应用 日趋广泛,但是由于GPS容易受到外界环境的 干扰,尤其是在高楼林立的城市,或者车辆通 过隧道及立交桥时,GPS 卫星信号将很差甚 至中断而无法定位。要得到连续可靠的定位 信息就需要其他的辅助手段。DR是典型的独 立定位技术,在短时间内能够保持较高的精 度,且其有效性不受外界影响,但该方法仅能 确定相对位臵,且误差将随推算过程而累加。
（2）传感器数据的集中处理导致滤波器的 容错性能较差。当一种传感器的数据出现 较大偏差时,该错误将会被传播到所有观 测量和状态变量的估计中去,导致状态污 染,滤波精度和稳定度下降。
分散式滤波技术就是为了解决集中式kalman滤 波器的上述缺陷而提出的, 它将单独的Kalman滤波 器用一个主滤波器和一组局部滤波器来代替,相应 的数据处理过程也分为两个阶段。在第一阶段中, 每个传感器的信息被送入对应的局部滤波器中处理, 产生局部最优状态估计;在第二阶段,主滤波器将局 部滤波器输出的局部状态估计进行融合处理,并产 生最终的全局状态最优估计。在分散滤波过程中, 由于不同传感器的数据被单独和并行处理,因而减 少了计算量,计算效率也大大提高。
实现GPS/DR组合的核心问题是数据融 合方案的设计,即采用何种方法来融合两 种定位系统的信息以获得最优的组合定位 结果。在车辆导航定位中有两种常用的组 合方案:切换式组合和Kalman滤波。
切换式组合方案有两种工作状态:GPS模式和 DR模式,系统工作在何种模式取决于GPS信号的有 效性:当GPS观测卫星数较多、卫星几何分布结构 较好时工作于GPS模式,同时利用GPS的定位输出 刷新DR系统的初始推算位臵;一旦GPS定位数据失 效或者GDOP增大到预定门限,则切换到DR模式。 该方法的优点是简单易行,系统承担的计算量很 小,可以解决在卫星信号失效时短时间的定位问 题。但是该方法并没有将GPS和DR两种系统的信 息融合在一起,不能完全发挥两者的优点。
根据利用GPS信息的不同,基于Kalman 滤波的GPS/DR组合方案又分为松组合和紧 组合两种:松组合直接利用GPS接收机输出 的定位解与DR进行数据融合;紧组合利用 GPS接收机输出的伪距、伪距率等原始信 息与DR所需要的信息(车辆行驶距离和方 位角 的变化)进行数据融合。
5.2
联邦滤波算法
因此,GPS和DR存在很强的互补关系。 一方面,GPS提供的绝对位臵信息可以为 DR提供推算定位的初始值并进行误差校正; 另一方面,DR的推算结果可用于补偿部分 GPS定位中的随机误差,从而平滑定位轨迹。 所以,利用适当的方法将两种系统组合起 来,充分利用其定位信息的互补性,就能够 获得比单独使用任何一种方法时都要高的 定位精度和可靠性。
利用kalman滤波实现多个传感器的信 息融合有两种途径:一种是标准的集中式 kalman滤波,另一种是分散式kalman滤波。 采用集中式kalman滤波,理论上可以获得 系统状态的最优估计,但是在实际应用中 存在着以下缺陷:
（1）采用严格最优估计的方法对系统所有 的测量量进行集中处理,系统状态维数高, 计算负担重,严重影响了滤波器的动态性 能和实时性。