CN101846747A - 用于精确相对定位的gps测量值的最佳编码 - Google Patents
用于精确相对定位的gps测量值的最佳编码 Download PDFInfo
- Publication number
- CN101846747A CN101846747A CN201010145474A CN201010145474A CN101846747A CN 101846747 A CN101846747 A CN 101846747A CN 201010145474 A CN201010145474 A CN 201010145474A CN 201010145474 A CN201010145474 A CN 201010145474A CN 101846747 A CN101846747 A CN 101846747A
- Authority
- CN
- China
- Prior art keywords
- vector
- eigenstate
- estimated
- gps
- difference signal
- 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
- 239000013598 vector Substances 0.000 claims abstract description 94
- 238000004891 communication Methods 0.000 claims abstract description 15
- 238000005259 measurement Methods 0.000 claims description 72
- 238000000034 method Methods 0.000 claims description 34
- 239000011159 matrix material Substances 0.000 description 16
- 238000010586 diagram Methods 0.000 description 12
- 238000007906 compression Methods 0.000 description 11
- 230000006835 compression Effects 0.000 description 11
- 238000012937 correction Methods 0.000 description 9
- 229910003460 diamond Inorganic materials 0.000 description 5
- 239000010432 diamond Substances 0.000 description 5
- 238000012545 processing Methods 0.000 description 5
- 239000000243 solution Substances 0.000 description 5
- 238000001914 filtration Methods 0.000 description 3
- 230000005540 biological transmission Effects 0.000 description 2
- 238000013144 data compression Methods 0.000 description 2
- 238000010790 dilution Methods 0.000 description 2
- 239000012895 dilution Substances 0.000 description 2
- 230000009977 dual effect Effects 0.000 description 2
- 240000007594 Oryza sativa Species 0.000 description 1
- 235000007164 Oryza sativa Nutrition 0.000 description 1
- 230000002596 correlated effect Effects 0.000 description 1
- 230000000875 corresponding effect Effects 0.000 description 1
- 230000006837 decompression Effects 0.000 description 1
- 230000001419 dependent effect Effects 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 235000009566 rice Nutrition 0.000 description 1
- 238000012502 risk assessment Methods 0.000 description 1
- 230000026676 system process Effects 0.000 description 1
- 230000001960 triggered effect Effects 0.000 description 1
Images
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/51—Relative positioning
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/42—Determining position
- G01S19/43—Determining position using carrier phase measurements, e.g. kinematic positioning; using long or short baseline interferometry
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Computer Networks & Wireless Communication (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
- Navigation (AREA)
Abstract
本发明涉及用于精确相对定位的GPS测量值的最佳编码。编码车辆卫星通信系统中的GPS测量值的系统。系统包括独立位置及速度估计器,其从在第一时间接收的GPS测量值和先前时间的本征状态矢量的预测值来产生估计本征状态矢量。系统还包括观测预测模型,其从估计本征状态矢量计算观测预测值。系统还包括第一差分器和第一Huffman编码器,第一差分器提供观测预测值和GPS测量值之间的差,第一Huffman编码器从所述差提供编码输出。系统还包括状态预测模型和第二差分器,状态预测模型提供预测本征状态矢量,第二差分器提供估计本征状态矢量和预测本征状态矢量之间的差。第二Huffman编码器编码来自于第二差分器的差。
Description
技术领域
本发明总体上涉及用于编码GPS测量值的系统和方法,且更具体地涉及用于编码车辆通信系统中的精确相对定位用的GPS测量值的系统和方法,其中,所述系统采用Huffman编码器。
背景技术
多个车辆的短基线精确相对定位具有很多民用应用。通过使用实时的相对GPS信号,车辆能够建立配备有GPS接收器和数据通信信道(例如,专用短程通信(DSRC)信道)的周围车辆(车辆至车辆目标地图)的相对位置和速度的分米以下水平的准确性。该协作安全系统能够以与雷达系统相同的方式提供位置和速度信息。
为了进行精确相对定位,车辆需要传送其原始GPS数据,例如代码范围、载波相位和多普勒测量值。在涉及大量车辆的拥挤交通情形下,这样做所需的带宽将成问题。
The Radio Technical Commission for Maritime Service SpecialCommittee 104(RTCM SC104)中所定义的数据格式包括不想要的冗余性。例如,信息类型#1(L1C/A代码相位校正)用0.02米分辨率一致地量化校正值。伪距测量值因而被表示在±0.2×215米的范围内。然而,伪距测量值通常限于大约±15米。因而应当注意的是,如果RTCM协议直接用于协作安全系统,将会发生过多的带宽浪费。
发明内容
根据本发明的教导,公开了用于编码车辆卫星通信系统中的GPS测量值的系统和方法。所述系统包括独立位置及速度估计器,所述独立位置及速度估计器从在第一时间接收的GPS测量值和先前时间的本征状态矢量的预测值来产生估计本征状态矢量。所述系统还包括观测预测模型,所述观测预测模型从所述估计本征状态矢量计算观测预测值。所述系统还包括第一差分器和第一Huffman编码器,所述第一差分器提供所述观测预测值和GPS测量值之间的差,所述第一Huffman编码器从所述差提供编码输出。所述系统还包括状态预测模型和第二差分器,所述状态预测模型提供预测本征状态矢量,所述第二差分器提供所述估计本征状态矢量和所述预测本征状态矢量之间的差。第二Huffman编码器编码来自于所述第二差分器的差。
方案1:一种用于编码车辆通信系统中的GPS测量值的系统,所述系统包括:
独立位置及速度估计器,所述独立位置及速度估计器接收第一时间的GPS测量信息和先前时间的本征状态矢量的预测值,所述位置及速度估计器产生估计本征状态矢量;
观测预测模型,所述观测预测模型响应于来自于所述位置及速度估计器的所述估计本征状态矢量且根据所述估计本征状态矢量计算观测预测值;
第一差分器,所述第一差分器响应于来自于所述观测预测模型的观测预测值和第一时间段的GPS测量信息且提供第一差信号;
第一编码器,所述第一编码器响应于所述第一差信号且提供第一编码输出;
状态预测模型,所述状态预测模型响应于来自于所述位置及速度估计器的所述估计本征状态矢量且输出预测本征状态矢量;
第二差分器,所述第二差分器响应于来自于所述位置及速度估计器的所述估计本征状态矢量和来自于所述状态预测模型的所述预测本征状态矢量且产生第二差信号;和
第二编码器,所述第二编码器响应于所述第二差信号且产生第二编码输出。
方案2:根据方案1所述的系统,其中:所述GPS测量信息是协议堆栈中的应用层的一部分。
方案3:根据方案2所述的系统,其中:所述GPS测量信息包括数据帧序列,所述数据帧包括初始帧、附加数据帧、差分帧和测量帧。
方案4:根据方案1所述的系统,其中:所述独立位置及速度估计器提供包括在卫星的地心地固坐标中的六维位置和速度的本征状态矢量。
方案5:根据方案1所述的系统,其中:所述GPS测量信息包括卫星星历表、代码范围、载波相位和卫星的多普勒偏移。
方案6:根据方案1所述的系统,其中:所述独立位置及速度估计器包括用于估计本征状态矢量的卡尔曼滤波器。
方案7:根据方案1所述的系统,其中:所述第一编码器和所述第二编码器提供具有数据的M-帧的第一编码输出和第二编码输出。
方案8:根据方案1所述的系统,其中:所述第一差分器和所述第二差分器提供模型残差。
方案9:根据方案1所述的系统,其中:所述第一编码器和所述第二编码器是Huffman编码器。
方案10:一种用于编码车辆通信系统中的GPS测量值的系统,所述系统包括:
独立位置及速度估计器,所述独立位置及速度估计器接收第一时间的GPS测量信息和先前时间的本征状态矢量的预测值,所述位置及速度估计器产生估计本征状态矢量,其中,所述GPS测量信息包括卫星星历表、代码范围、载波相位和卫星的多普勒偏移,且包括数据帧序列,所述数据帧包括初始帧、附加数据帧、差分帧和测量帧,其中,所述独立位置及速度估计器提供包括在卫星的地心地固坐标中的六维位置和速度的本征状态矢量;
观测预测模型,所述观测预测模型响应于来自于所述位置及速度估计器的所述估计本征状态矢量且根据所述估计本征状态矢量计算观测预测值;
第一差分器,所述第一差分器响应于来自于所述观测预测模型的观测预测值和第一时间段的GPS测量信息且提供包括模型残差的第一差信号;
第一Huffman编码器,所述第一Huffman编码器响应于所述第一差信号且提供第一编码输出;
状态预测模型,所述状态预测模型响应于来自于所述位置及速度估计器的所述估计本征状态矢量且输出预测本征状态矢量;
第二差分器,所述第二差分器响应于来自于所述位置及速度估计器的所述估计本征状态矢量和来自于所述状态预测模型的所述预测本征状态矢量且产生包括模型残差的第二差信号;和
第二Huffman编码器,所述第二Huffman编码器响应于所述第二差信号且产生第二编码输出。
方案11:根据方案10所述的系统,其中:所述GPS测量信息是协议堆栈中的应用层的一部分。
方案12:根据方案10所述的系统,其中:所述独立位置及速度估计器包括用于估计本征状态矢量的卡尔曼滤波器。
方案13:根据方案10所述的系统,其中:所述第一Huffman编码器和所述第二Huffman编码器提供具有数据的M-帧的第一编码输出和第二编码输出。
方案14:一种用于编码车辆通信系统中的GPS测量值的方法,所述方法包括:
使用第一时间的GPS测量信息和先前时间的本征状态矢量的预测值来估计本征状态矢量;
从所估计本征状态矢量计算观测预测值;
提供观测预测值和第一时间段的GPS测量信息之间的第一差信号;
编码所述第一差信号以提供第一编码输出;
使用状态预测模型以通过使用所估计本征状态矢量来产生预测本征状态矢量;
提供所估计本征状态矢量和所述预测本征状态矢量之间的第二差信号;和
编码所述第二差信号以产生第二编码输出。
方案15:根据方案14所述的方法,其中:编码第一差信号和第二差信号包括提供数据的M-帧。
方案16:根据方案14所述的方法,其中:提供第一差信号和第二差信号包括提供模型残差。
方案17:根据方案14所述的方法,其中:编码第一差信号和第二差信号包括使用Huffman编码器。
方案18:根据方案14所述的方法,其中:估计本征状态矢量包括估计具有卫星的地心地固坐标中的六维位置和速度的本征状态矢量。
方案19:根据方案14所述的方法,其中:估计本征状态矢量包括使用卡尔曼滤波器来估计本征状态矢量。
方案20:根据方案14所述的方法,其中:所述GPS测量信息包括卫星星历表、代码范围、载波相位和卫星的多普勒偏移。
本发明的附加特征将从以下说明和所附权利要求书结合附图显而易见。
附图说明
图1是用于主车辆和远程车辆的系统通信架构的框图;
图2是示出了图1所示的架构中的处理单元的操作的流程图;
图3是示出了用于求解车辆之间的相对位置和速度矢量的过程的框图;
图4是车辆和卫星之间的相对位置的图示;
图5(a)是示出了车辆主节点和其它车辆节点的图表的图示,其中具有相对于车辆主节点和其它车辆节点的基线;
图5(b)示出了包括主节点和其它车辆节点的最佳生成树,其中具有在主节点和其它车辆节点之间的最佳基线;
图6是示出了多车辆精确相对定位的过程的流程图;
图7是示出了GPS测量值的压缩的系统的框图;
图8是示出了用于解压缩GPS测量值的系统的框图;
图9是提出的压缩方案的总体框图;
图10是协议堆栈的图示;
图11是帧序列的示例;
图12是示出了用于建立Huffman码字字典的过程的流程图;和
图13是用于编码GPS数据以便传输的算法的流程图。
具体实施方式
涉及用于编码车辆卫星通信系统中的精确相对定位用的GPS测量值的系统和方法的本发明实施例的以下讨论本质上仅仅是示例性的,而决不旨在限制本发明或其应用或使用。
图1示出了用于主车辆12和远程车辆14的通信架构10。主车辆12和远程车辆14各配备有无线收音机16,所述无线收音机16包括用于通过天线18传送和接收无线信息包的发送器和接收器(或收发器)。每个车辆包括GPS接收器20,GPS接收器20接收卫星星历表、代码范围、载波相位和多普勒频移观测值。每个车辆也包括用于减少通信带宽要求的数据压缩和解压缩单元22。每个车辆也包括用于建立车辆至车辆(V2V)目标地图的数据处理单元24。所建立的V2V目标地图由车辆安全应用26使用。架构10还可包括用于收集信息的车辆接口装置28,所述信息包括但不限于车辆速度和偏航速率。
图2是示出了架构10中的处理单元24的操作的流程图38。一旦在决策菱形块40处接收新数据,就触发处理单元24。在框42,第一步骤收集卫星星历表(即具体时间时的卫星轨道参数)、代码范围(伪距)、载波相位观测值、和主车辆12的车辆数据。在框44,第二步骤确定主车辆12的位置和速度,其用作随后精确相对定位方法的移动参考。在框46,第三步骤压缩GPS和车辆数据。在框48,第四步骤传送GPS和车辆数据。在框50,第五步骤从远程车辆收集无线数据包。在框52,第六步骤解压缩所接收的数据包且导出每个远程车辆的GPS和车辆数据。在框54,第七步骤使用精确相对定位方法来建立V2V目标地图。在框56,第八步骤将V2V目标地图输出给高级别安全应用,用于其危险评估算法。
数据处理单元24可以在下文进一步描述。令X1,X2,...,XK为K个车辆。令Xi是第i个车辆的状态,包括在地心地固坐标(ECEF)中的位置和速度。令XH是主车辆12的状态,其中,1≤H≤K。令X是卫星的状态,包括在ECEF坐标中的位置和速度,其可以通过由第j个卫星传送的星历表消息确定。
图3示出了用于精确求解车辆之间的相对位置和速度矢量的流程图60。流程图60包括空中(OTF)联合定位及模糊度确定模块62,其从各个源接收信息,包括在框64处的车辆数据、在框66处的车辆独立位置、在框68处的卫星星历表和在框70处的GPS观测值的双重差分,如下所讨论的。在框72,模块62输出其它车辆的位置速度和模糊度。要注意的是,需要一个车辆的绝对坐标。在仅仅包括移动车辆的系统中,移动参考坐标简单地使用独立定位模块来估计,以提供参考基准坐标的近似坐标。
使用用于短基线的双重差分载波相位测量值来实现高定位精度。载波相位测量值优于代码测量值,因为它们能够被测量为优于0.01λ,其中λ是载波信号的波长,载波信号对应于毫米精度且比其代码对等物受多路径的影响更少。然而,载波相位通过循环数的整数模糊化,所述循环数必须在车辆操作期间被确定。
令主车辆Xh是移动参考站。令bih是主车辆Xh和远程车辆Xi之间的基线。载波相位的以下双重差分测量值、代码和多普勒测量值可以写成:
d=H(XH,bih)bih+λN+vih (1)
H(XH,bih)是取决于移动主车辆XH和基线bih的测量矩阵,λ是载波的波长,N是模糊度双重差分的矢量,vih是未建模测量噪音。在不丧失一般性的情况下,假设等式(1)被标准化,即,vih的协方差矩阵是单位矩阵。
流程图60的核心是空中(OTF)联合定位及模糊度确定模块62。在模块62中,采用(6+J-1)维状态跟踪滤波器来估计三个位置和三个速度分量以及J-1浮动模糊度双重差分如下:
注意到矩阵对主车辆Xh和基线bih的变化不是非常敏感。借助于可获得的基线的过程等式,使用先前时刻的主车辆XH和预测估计值通常就足够了。因而,当可获得值d时,通过下述滤波可以获得基线bih的更好的估计。
令基线bih的过程等式为:
bih(t+1)=f[bih(t)]+w (3)
其中w表示未建模噪音。
其中,I是单位矩阵, 且
注意到OTF联合滤波过程可以写成下文所述的算法1。
在等式(1)中,测量矩阵H(XH,bih)对上述单基线定位方法收敛至正确解起到重要的作用。几何精度因子(GDOP)(即,[H(XH,bih)]-1)影响对基线bih的估计的质量。可以确认GDOP取决于对基线bih而言共用卫星的数量和共同卫星的星座。例如,当远程车辆和主车辆之间的可见共用共同卫星在天空靠拢在一起时,几何构型是弱的且GDOP值高。当远程车辆和主车辆之间的可见共用共同卫星相距较远时,几何构型是强的且GDOP值低。因而,低GDOP值表示由于卫星之间的更宽角间隔引起的更好的基线精度。极端情况是在共用卫星数量少于4时GDOP无限大。
图4是用于说明上文的讨论的车辆82、84和86的图示,其中,车辆82是主车辆。在车辆82和84之间限定基线88(bAB),在车辆84和86之间限定基线90(bBC),而在车辆82和86之间限定基线92(bAC)。建筑物94定位在车辆82和86之间,且操作阻挡某些卫星的信号,从而车辆82和86仅从相同卫星中的一些接收信号。具体地,车辆82从卫星1、9、10、12、17和21接收信号,车辆84从卫星1、2、4、5、7、9、10、12、17和21接收信号,而车辆86从卫星1、2、4、5、7和9接收信号。因而,车辆84和86从共同卫星1、2、4、5、6和9接收信号,而车辆82和84仅从共同卫星1和9接收信号。因而,车辆82和86没有从足以获得相对位置和速度的共同卫星接收信号,因为需要最少四个卫星。
要注意的是,在多个车辆中进行定位有多于一个解。考虑图4所示的情形,其中主车辆82需要分别估计车辆84和86的相对位置和速度,即基线bAB和bAC。基线bAC可以直接使用单基线定位方法估计或者可以通过组合两个其它基线估计值来导出,如下:
bAC=bAB+bBC (5)
类似地,基线bAB具有两个解。可以确认,两个解的质量是不同的。目标是寻找最佳解。如图4所示,由于建筑物94引起的阻挡,基线bAC的估计值的质量由于观测到少于四个共用卫星(PRN1,9)而降级。另一方面,从基线bAB和bAC推出的基线bAC比基线bAC的直接估计值更好。
来自于图4的构思可以通过引入图表G来概括,其中顶点表示车辆而边缘表示两个顶点之间的基线。令边缘的权重为两个车辆之间的基线的GDOP。目标是寻找生成树,即选择形成跨越每个顶点的树的G的边缘,其中主车辆被指定为根,从而从根到所有其它顶点的路径具有最小GDOP。
图5(a)是示出了节点102处的主车辆和节点104处的其它车辆的这种加权图表100的图示,其中,主节点102和节点104之间以及其它节点104之间的边缘或基线106给予由合适的GDOP算法确定的权重。图5(b)示出了去除了非最佳边缘或基线的最佳生成树108。
图6是示出了用于限定图5(a)所示的加权图表100和图5(b)所示的最佳生成树108的过程的流程图110。流程图110包括在框112建立节点的加权图表100和然后在框114寻找图表100的最佳生成树的步骤。所述算法然后在框114计算图表100的边缘的基线,且在决策菱形块118确定是否处理图表100的生成树中的所有边缘,并且如果否,返回框116以计算下一基线。所述算法然后在框120计算所有车辆相对于主车辆的相对位置和速度。
在流程图110中计算基线以获得最小GDOP的步骤可以通过适合于本文所述目的的任何算法执行。第一算法(称为算法1)基于单基线精确定位。令联合状态的先前估计值且其协方差矩阵双重差分d;接收器的GPS时标tR;卫星星历表E;系统的动态等式(1);测量等式(2);等式(3)中噪音项w的协方差矩阵Q;以及等式(2)中噪音项v的协方差矩阵R。
在时间t联合状态和协方差矩阵的更新估计值可以求解如下:
且
2.计算修正误差(innovation error)如下:
其中
3.计算修正协方差
4.计算卡尔曼增益为:
多个车辆的精确相对定位也可以通过以下算法(称为算法2)确定。
1.建立车辆的加权图表G,其中,每个车辆是顶点且如果共用观测卫星的数量大于或等于四那么在两个车辆之间增加边缘。令根表示主车辆。
2.边缘的权重等于由两个车辆观测的共同卫星的几何精度因子(GDOP),即,对于顶点i和j之间的边缘权重而言,等式(1)中的det[H(XH,bih)]-1。
3.使用动态编程(算法3的修改Bellman-Ford算法或算法4的Dijkstra算法)来寻找生成树,使得来自于任何其它节点的路径具有用于定位的最佳卫星几何构型(最小GDOP)。
4.开始for循环:对于图表G中的所有E,进行(for all E in the graphG do):
5.通过算法1所述的算法确定边缘E所表示的基线。
6.结束for循环(end for)
7.基于图表G计算从车辆到主车辆的相对位置和速度。
算法3是反向Bellman-Ford算法
给定图表G,其中顶点V={vi|1≤i≤|V|}、边缘E={ek|1≤k≤|E|}、以及边缘的权重{wk|1≤k≤|E|};顶点源H。
确保:生成树T和G:
1.开始for循环:对于顶点集合中的所有顶点v,进行:
2.开始if条件:如果v是源,那么(if v is the source then)
3.令cost(v)为0。
4.否则
5.令cost(v)为∞。
6.结束if条件(end if)
7.令predecessor(v)为空。
8.结束for循环
9.开始for循环:对于i从1至|V|-1,进行:
10.开始for循环:对于E中的每个边缘ek,进行:
11.令u为e的源顶点。令v是ek的目标顶点。
12.开始if条件:如果cost(v)小于max(wk,cost(u)),那么
13.令cost(v)=max(wk,cost(u))。
14.令predecessor(v)=u。
15.结束if条件
16.结束for循环
17.结束for循环
18.针对所有顶点使用predecessor(v)来建立生成树T。
算法4是修改的Dijkstra算法:
给定图表G,其中顶点V={vi|1≤i≤|V|}、边缘E={ek|1≤k≤|E|}、以及边缘的权重{wk|1≤k≤|E|};顶点源H。
确保:生成树T和G:
1.开始for循环:对于顶点集合中的所有顶点v,进行:
2.开始if条件:如果v是源H,那么
3.令cost(v)为0。
4.否则
5.令cost(v)为∞。
6.结束if条件
7.令predecessor(v)为空。
8.结束for循环
9.令集合Q包含V中的所有顶点。
10.开始for循环:对于Q非空,进行:
11.令u是Q中具有最小成本的顶点。从Q去除u。
12.开始for循环:如果对于u的每个邻居v,进行:
13.令e是u和v之间的边缘。令alt=max(cost(u),weight(e))。
14.开始if条件:如果alt<cost(v),那么
15.cost(v)=alt
16.令predecessor(v)为u。
17.结束if条件
18.结束for循环
19.结束for循环
20.针对所有顶点使用predecessor(v)来建立生成树T。
GPS测量值通过GPS接收器的位置和速度的本征矢量相关联,其可以表示如下。
令X是包括ECEF坐标中的位置和速度的六维本征状态矢量。令C是包括ECEF坐标中的卫星的位置和速度的卫星星座,其可以通过由卫星传送的星历表消息确定。令GPS测量的量O包括来自于卫星的接收器的代码范围、载波相位和多普勒偏移。因而,测量等式可以写为:
图7是包括独立绝对定位模块132的系统130的框图,独立绝对定位模块132接收框134处的卫星观测值和框136处的卫星星历表。来自于定位模块132的预测观测值和卫星观测值提供给加法器138,其中,由编码器140编码信号之间的差。在框142,来自于编码器140的编码信号和来自于定位单元132的绝对定位速度信号作为车辆绝对定位和速度信号和压缩修正误差提供。
独立绝对定位模块132监测测量值(包括代码范围、载波相位和多普勒偏移)的输入、卫星星座C的输入、以及车辆数据(例如,车轮速度和偏航速率)。模块132产生GPS接收器的绝对位置和速度模块132也产生由函数h表示的预测GPS测量值
因而,修正误差e可以定义为:
可以确认,修正误差矢量具有两个属性。分量彼此不相关,且对于每个分量,偏差远小于GPS测量值O的对等物。因而,标准数据压缩方法(例如但不限于矢量化或Huffman编码)可以应用于修正误差e且实现良好的压缩性能。
图8是示出了压缩模块的反向操作的框图150且示出了如何从来自于无线收音机模块的接收压缩数据恢复GPS测量值的步骤。具体地,在框152处的压缩修正误差提供给解码器154,且框156处的车辆绝对位置和速度信号以及框158处的卫星星历表信号提供给计算预测观测模块160。在框164,来自于解码器154和观测模块160的信号由加法器162相加以提供卫星观测值,例如代码范围、载波相位和多普勒频率。
因而,恢复的GPS测量值可以计算为:
GPS测量值与时间高度相关。这使得它们非常适合于使用本征状态矢量X的预测模型来压缩。令在时刻t时本征状态的过程等式为:
X(t+1)=f(X(t))+w (11)
其中,f是主车辆的系统过程函数(例如,恒定速度模型或恒定转向模型),其中GPS接收器安装在车顶上且w是过程等式中的未建模噪音。
等式(11)中残差非常适合于通过编码当前状态矢量和来自于先前时刻的预测状态矢量之间的差来压缩。
图9是所提出的压缩方案的系统170。独立位置及速度估计器172监测时刻t时的GPS测量值的输入O(t)和来自于先前时间t-1的本征状态矢量的预测值且产生本征状态矢量的新估计值观测预测模型模块174使用等式(6)计算观测预测值Huffman编码器I模块176基于所导出的Huffman树使用可变长度编码来编码来自加法器184的输入O(t)和模型预测值之间的差。单位延迟模块178存储先前本征状态矢量状态预测模型180计算本征状态的预测值Huffman解码器II模块182基于Huffman树使用可变长度编码来编码来自于加法器186的本征状态矢量和模型预测值之间的差。
GPS协议的最小描述长度压缩(MDLCOG)设计为在传输层上方提供的应用层,如图10所示。具体地,MDLCOG是在协议堆栈190中位于GPS数据层192和传输层196之间的应用层194。网络层198在传输层196下方,且数据链路层200处于协议堆栈190的底部。
MDLCOG包括消息集(称为帧),用于初始化和传输测量值和附加数据,例如观测卫星的GPS时标和位图。这些数据帧称为初始帧(I-帧)、附加数据帧(A-帧)、差分帧(D-帧)和测量帧(M-帧)。
在数据传输开始时,编码器发送I-帧以初始化解码器处的状态预测模块。I-帧类似于在音频MPEG标准中使用的关键帧。I-帧包含由编码器估计的在ECEF坐标中的GPS接收器的绝对位置和速度。每当本征状态X的当前和先前估计值之间的差大于阈值时,也发送I-帧。
A-帧包含非测量数据,例如卫星列表、数据质量指示器等。A-帧仅在启动时和在内容变化时传输。
最经常传输的帧是D-帧和M-帧。在如下的意义上D-帧类似于在MPEG音频编码标准中使用的P图片帧:它们参考先前编码的样本进行编码。D-帧中的时间序列差使用在等式(11)中表示的车辆动态模型。每个D-帧包含本征状态X的当前和先前估计值之间的Huffman编码差。M-帧包括GPS时标以及测量值O和预测值之间的Huffman编码差。每当接收新的GPS测量值时,M-帧被发送,且单独的帧针对M-帧的L1和L2频率进行传输。
一旦已经初始化解码器,已经接收合适的I-帧和A-帧,编码器就传输对应D-帧和M-帧中的每个时间点(epoch)的量化预测残差。帧序列的示例在图11中示出。M-帧在每个时间点被发送。在时间点1,I-帧和A-帧被发送以初始化解码器中的预测模块。在时间点6,I-帧被再次发送,因为检测到本征状态X估计值的显著变化。在时间点8,传输A-帧,因为卫星显现出地平线或者卫星着地。
图12是概述用于建立字典以编码残差的过程的流程图210。在框212,收集双频GPS数据的大量数据。在框214,计算测量残差e或状态预测残差w的集合。在框216,选择量化残差的具体分辨率(例如,根据RTCM协议伪距为0.2米)且获得符号列表。在框218,计算集合中每个符号的频率。在框220,令A={a1,a2,...,an},其为具有大小n的符号字母表。然后,令P={p1,p2,...,pn},其为(正)符号频率的集合,即,pi=frequency(ai),1≤i≤n。通过建立Huffman树来产生代码C(A,P)={c1,c2,...,cn},其为(二进制)码字的集合,其中,ci是ai的码字,1≤i≤n。
图13是用于编码GPS数据的算法的流程图230。在决策菱形块232,一旦从GPS装置接收新数据,过程就开始,且如果没有接收数据,那么过程在框234结束。然后,在框236收集GPS数据O,所述GPS数据包括来自于第j个卫星Xj的伪距Rj、多普勒偏移Dj和载波相位Φj,第j个卫星Xj属于集合C={Xj|1≤j≤J},其中J为可见卫星的数量。值Xj包括ECEF坐标中第j个卫星的三维位置。
所述算法然后在决策菱形块238确定卫星地图是否已经变化,且如果是,所述算法在框240产生A-帧。具体地,如果卫星星座C的标识(即,PRN)从先前时刻变化,那么产生A-帧以编码观测卫星PRN的列表。所述帧包括32位地图,其中,取决于具体卫星的存在数据,每一位是真或假。
所述算法然后在框242估计车辆的独立位置和速度。在估计独立位置及速度模块中,使用卡尔曼滤波器通过测量值O序列来估计本征状态矢量X。令本征状态矢量分别表示ECEF坐标中的三维位置矢量、ECEF坐标中的三维速度矢量、接收器时钟误差和接收器时钟误差变化率的链接矢量(concatenated vector)。等式(6)在邻域X*处的线性化系统可以写成:
X(t+1)=FX(t)+u1+w (12)
其中,F是关于本征状态矢量X和非线性项u1=f(X*)-FX*的Jacobian矩阵。
第j个卫星的等式(6)的测量值可以扩展成:
Rj=ρj+cβ+vR
λΦi=ρj+cβ+λNj+vФ(13)
对于j=1,...,J,其中ρj是接收器和第j个卫星之间的几何距离,是投射到从接收器到卫星的方向上的第j个卫星的速度矢量的投影,c表示光速,λ和f分别是载波信号的波长和频率,vR、vΦ和vD分别是伪距、载波相位和多普勒偏移的未建模测量噪音,且xj、yj和zj是ECEF坐标中的第j个卫星的三维位置。
注意,量ρj和取决于本征状态矢量X的矢量。换句话说,等式(13)包括关于本征状态矢量X的非线性等式。这些量对本征状态矢量X的变化不是非常敏感。在接收器动态可用时,使用先前时刻的预测估计值作为线性化邻域X*的中心且用之取代等式(13)中的本征状态矢量X通常就足够了。因而,当Rj、Φj和Dj可用时,可以通过在下文详述的算法5中所述的滤波方法来获得本征状态矢量X的更好估计值。
等式(13)可以在邻域X*中线性化为:
Oj=HjX+u2j+vj (14)
其中,Oj=[Rj,Φj,Dj]T,Hj是关于本征状态矢量X和非线性项u2j=h(X*)-HjX*的等式(13)的Jacobian矩阵。因而,估计独立位置及速度模块的关键步骤可以在算法5中概述。
所述算法然后在决策菱形块244确定当前状态估计值X(t)和先前状态估计值X(t-1)是否大于阈值T。如果当前状态估计值X(t)和先前状态估计值X(t-1)之间的差大于阈值T,那么在框248产生I-帧。I-帧编码当前状态估计值X(t),包括接收器的ECEF位置和速度。否则,在框246产生D-帧以使用Huffman码字字典来编码差X(t)-X(t-1)。
下一步骤是在框250计算测量值的建模残差:
e=O-h(X)(15)
然后,在框252,测量建模残差通过产生M-帧使用Huffman码字字典来编码。在框254的最后步骤中,所有产生的帧传输给下部UDP层196。
算法5,绝对位置更新:
给定本征状态的先前估计值且其协方差矩阵测量值O(t);接收器的GPS时标tR;卫星星历表E;系统动态等式(4);测量等式(6);等式(4)中的噪音项w的协方差矩阵Q;等式(6)中的噪音项v的协方差矩阵R。
1.计算预测值 和
2.开始for循环:对于所有j,1≤j≤J,进行:
3.接收第j个卫星的卫星星历表。
4.计算第j个卫星的ECEF位置 和速度
6.使用等式(7)计算Hj。
7.结束for循环
8.计算H=[H1 T,…,HJ T]T。
9.使用等式(5)计算修正误差,即
10.计算修正协方差
11.计算卡尔曼增益
12.输出更新估计值 和协方差矩阵
前述讨论仅仅公开和描述了本发明的示例性实施例。本领域技术人员从这种讨论和附图以及权利要求将容易认识到:可以对本文进行各种变化、修改和变型,而不偏离由所附权利要求限定的本发明的精神和范围。
Claims (10)
1.一种用于编码车辆通信系统中的GPS测量值的系统,所述系统包括:
独立位置及速度估计器,所述独立位置及速度估计器接收第一时间的GPS测量信息和先前时间的本征状态矢量的预测值,所述位置及速度估计器产生估计本征状态矢量;
观测预测模型,所述观测预测模型响应于来自于所述位置及速度估计器的所述估计本征状态矢量且根据所述估计本征状态矢量计算观测预测值;
第一差分器,所述第一差分器响应于来自于所述观测预测模型的观测预测值和第一时间段的GPS测量信息且提供第一差信号;
第一编码器,所述第一编码器响应于所述第一差信号且提供第一编码输出;
状态预测模型,所述状态预测模型响应于来自于所述位置及速度估计器的所述估计本征状态矢量且输出预测本征状态矢量;
第二差分器,所述第二差分器响应于来自于所述位置及速度估计器的所述估计本征状态矢量和来自于所述状态预测模型的所述预测本征状态矢量且产生第二差信号;和
第二编码器,所述第二编码器响应于所述第二差信号且产生第二编码输出。
2.根据权利要求1所述的系统,其中:所述GPS测量信息是协议堆栈中的应用层的一部分。
3.根据权利要求2所述的系统,其中:所述GPS测量信息包括数据帧序列,所述数据帧包括初始帧、附加数据帧、差分帧和测量帧。
4.根据权利要求1所述的系统,其中:所述独立位置及速度估计器提供包括在卫星的地心地固坐标中的六维位置和速度的本征状态矢量。
5.根据权利要求1所述的系统,其中:所述GPS测量信息包括卫星星历表、代码范围、载波相位和卫星的多普勒偏移。
6.根据权利要求1所述的系统,其中:所述独立位置及速度估计器包括用于估计本征状态矢量的卡尔曼滤波器。
7.根据权利要求1所述的系统,其中:所述第一编码器和所述第二编码器提供具有数据的M-帧的第一编码输出和第二编码输出。
8.根据权利要求1所述的系统,其中:所述第一差分器和所述第二差分器提供模型残差。
9.一种用于编码车辆通信系统中的GPS测量值的系统,所述系统包括:
独立位置及速度估计器,所述独立位置及速度估计器接收第一时间的GPS测量信息和先前时间的本征状态矢量的预测值,所述位置及速度估计器产生估计本征状态矢量,其中,所述GPS测量信息包括卫星星历表、代码范围、载波相位和卫星的多普勒偏移,且包括数据帧序列,所述数据帧包括初始帧、附加数据帧、差分帧和测量帧,其中,所述独立位置及速度估计器提供包括在卫星的地心地固坐标中的六维位置和速度的本征状态矢量;
观测预测模型,所述观测预测模型响应于来自于所述位置及速度估计器的所述估计本征状态矢量且根据所述估计本征状态矢量计算观测预测值;
第一差分器,所述第一差分器响应于来自于所述观测预测模型的观测预测值和第一时间段的GPS测量信息且提供包括模型残差的第一差信号;
第一Huffman编码器,所述第一Huffman编码器响应于所述第一差信号且提供第一编码输出;
状态预测模型,所述状态预测模型响应于来自于所述位置及速度估计器的所述估计本征状态矢量且输出预测本征状态矢量;
第二差分器,所述第二差分器响应于来自于所述位置及速度估计器的所述估计本征状态矢量和来自于所述状态预测模型的所述预测本征状态矢量且产生包括模型残差的第二差信号;和
第二Huffman编码器,所述第二Huffman编码器响应于所述第二差信号且产生第二编码输出。
10.一种用于编码车辆通信系统中的GPS测量值的方法,所述方法包括:
使用第一时间的GPS测量信息和先前时间的本征状态矢量的预测值来估计本征状态矢量;
从所估计本征状态矢量计算观测预测值;
提供观测预测值和第一时间段的GPS测量信息之间的第一差信号;
编码所述第一差信号以提供第一编码输出;
使用状态预测模型以通过使用所估计本征状态矢量来产生预测本征状态矢量;
提供所估计本征状态矢量和所述预测本征状态矢量之间的第二差信号;和
编码所述第二差信号以产生第二编码输出。
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
US12/412,688 US20100250132A1 (en) | 2009-03-27 | 2009-03-27 | Optimal coding of gps measurements for precise relative positioning |
US12/412688 | 2009-03-27 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN101846747A true CN101846747A (zh) | 2010-09-29 |
CN101846747B CN101846747B (zh) | 2013-01-02 |
Family
ID=42771426
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2010101454747A Expired - Fee Related CN101846747B (zh) | 2009-03-27 | 2010-03-29 | 用于精确相对定位的gps测量值的最佳编码 |
Country Status (3)
Country | Link |
---|---|
US (1) | US20100250132A1 (zh) |
CN (1) | CN101846747B (zh) |
DE (1) | DE102010012405A1 (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103138055A (zh) * | 2011-12-05 | 2013-06-05 | 深圳市金溢科技有限公司 | 比相无线定位天线及其系统、使用比相无线定位的方法 |
CN104536026A (zh) * | 2015-01-08 | 2015-04-22 | 中国航空无线电电子研究所 | 一种动态对动态实时测量系统 |
CN110161504A (zh) * | 2018-02-15 | 2019-08-23 | 通用汽车环球科技运作有限责任公司 | 解决多普勒频移的车辆雷达系统及其使用方法 |
CN112533234A (zh) * | 2019-09-19 | 2021-03-19 | 中国移动通信集团重庆有限公司 | 基于机器学习的5g载波带宽配置方法及装置 |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9286679B2 (en) | 2014-07-22 | 2016-03-15 | GM Global Technology Operations LLC | Misalignment correction and state of health estimation for lane management fusion function |
US10017179B2 (en) | 2016-06-06 | 2018-07-10 | GM Global Technology Operations LLC | Method for optimizing inter-vehicle distance and equitably sharing fuel benefits in a vehicle platoon |
US10252717B2 (en) | 2017-01-10 | 2019-04-09 | Toyota Jidosha Kabushiki Kaisha | Vehicular mitigation system based on wireless vehicle data |
US11722705B2 (en) * | 2020-03-26 | 2023-08-08 | Toyota Motor Engineering & Manufacturing North America, Inc. | Camera support by a vehicular micro cloud for remote driving |
CN112747742B (zh) * | 2020-12-22 | 2022-10-14 | 上海交通大学 | 一种基于卡尔曼滤波的终端位置自适应更新方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1213626A (zh) * | 1997-10-07 | 1999-04-14 | 财团法人工业技术研究院 | 应用调频副载波及差分修正卫星定位技术的汽车防盗器 |
US20050021229A1 (en) * | 2003-07-21 | 2005-01-27 | Lg Electronic Inc. | Apparatus and method for detecting vehicle location in navigation system |
CN1854754A (zh) * | 2005-04-29 | 2006-11-01 | 通用汽车环球科技运作公司 | 基于卫星无线电的车辆定位系统 |
CN101846735A (zh) * | 2009-03-27 | 2010-09-29 | 通用汽车环球科技运作公司 | 用于在多个车辆中进行精确相对定位的方法和设备 |
Family Cites Families (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE4026740A1 (de) * | 1990-08-24 | 1992-02-27 | Wild Heerbrugg Ag | Verfahren zur praezisen lagebestimmung |
US5323163A (en) * | 1993-01-26 | 1994-06-21 | Maki Stanley C | All DOP GPS optimization |
US5451964A (en) * | 1994-07-29 | 1995-09-19 | Del Norte Technology, Inc. | Method and system for resolving double difference GPS carrier phase integer ambiguity utilizing decentralized Kalman filters |
US6014101A (en) * | 1996-02-26 | 2000-01-11 | Trimble Navigation Limited | Post-processing of inverse DGPS corrections |
US6057800A (en) * | 1996-06-28 | 2000-05-02 | State University Of New York | RDOP surface for GPS relative positioning |
US6167347A (en) * | 1998-11-04 | 2000-12-26 | Lin; Ching-Fang | Vehicle positioning method and system thereof |
US20020008661A1 (en) * | 2000-07-20 | 2002-01-24 | Mccall Hiram | Micro integrated global positioning system/inertial measurement unit system |
US6667698B2 (en) * | 2002-03-25 | 2003-12-23 | Hewlett-Packard Development Company, L.P. | Distributed compression and transmission method and system |
US7084809B2 (en) * | 2002-07-15 | 2006-08-01 | Qualcomm, Incorporated | Apparatus and method of position determination using shared information |
-
2009
- 2009-03-27 US US12/412,688 patent/US20100250132A1/en not_active Abandoned
-
2010
- 2010-03-23 DE DE102010012405A patent/DE102010012405A1/de not_active Withdrawn
- 2010-03-29 CN CN2010101454747A patent/CN101846747B/zh not_active Expired - Fee Related
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1213626A (zh) * | 1997-10-07 | 1999-04-14 | 财团法人工业技术研究院 | 应用调频副载波及差分修正卫星定位技术的汽车防盗器 |
US20050021229A1 (en) * | 2003-07-21 | 2005-01-27 | Lg Electronic Inc. | Apparatus and method for detecting vehicle location in navigation system |
CN1854754A (zh) * | 2005-04-29 | 2006-11-01 | 通用汽车环球科技运作公司 | 基于卫星无线电的车辆定位系统 |
CN101846735A (zh) * | 2009-03-27 | 2010-09-29 | 通用汽车环球科技运作公司 | 用于在多个车辆中进行精确相对定位的方法和设备 |
Non-Patent Citations (1)
Title |
---|
《计算机应用研究》 20070228 孙棣华等 《基于GPS探测车的道路交通状态估计技术》 全文 1-20 , 第2期 * |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103138055A (zh) * | 2011-12-05 | 2013-06-05 | 深圳市金溢科技有限公司 | 比相无线定位天线及其系统、使用比相无线定位的方法 |
CN104536026A (zh) * | 2015-01-08 | 2015-04-22 | 中国航空无线电电子研究所 | 一种动态对动态实时测量系统 |
CN110161504A (zh) * | 2018-02-15 | 2019-08-23 | 通用汽车环球科技运作有限责任公司 | 解决多普勒频移的车辆雷达系统及其使用方法 |
CN112533234A (zh) * | 2019-09-19 | 2021-03-19 | 中国移动通信集团重庆有限公司 | 基于机器学习的5g载波带宽配置方法及装置 |
Also Published As
Publication number | Publication date |
---|---|
US20100250132A1 (en) | 2010-09-30 |
CN101846747B (zh) | 2013-01-02 |
DE102010012405A1 (de) | 2010-12-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN101846735A (zh) | 用于在多个车辆中进行精确相对定位的方法和设备 | |
CN101846747A (zh) | 用于精确相对定位的gps测量值的最佳编码 | |
US11719830B2 (en) | RTK vector phase locked loop architecture | |
CN106855632B (zh) | 一种广播式vrs定位方法及系统 | |
CN108076662B (zh) | 具有使用未组合公式来解算模糊度的能力的gnss接收机 | |
Zhang et al. | 3D mapping database aided GNSS based collaborative positioning using factor graph optimization | |
EP1498745B1 (en) | Enhanced real time kinematics determination method and apparatus | |
AU2008260578B2 (en) | Distance dependant error mitigation in real-time kinematic (RTK) positioning | |
US8164514B1 (en) | Method and apparatus for fusing referenced and self-contained displacement measurements for positioning and navigation | |
KR20210008385A (ko) | 항법 강화 방법 및 시스템 | |
CN114502987A (zh) | 用于高斯过程增强的gnss校正生成的系统和方法 | |
EP3430434A1 (en) | Rapid determination of precise position by aiding data | |
CN109313272B (zh) | 使用速度积分的改进gnss接收器 | |
WO2015194061A1 (ja) | 変換装置及びプログラム | |
US10194269B2 (en) | Systems and methods for using doppler measurements to estimate a position of a receiver | |
US20150301189A1 (en) | Method and apparatus for modeling of gnss pseudorange measurements for interpolation, extrapolation, reduction of measurement errors, and data compression | |
AU2021302454B2 (en) | Method for determining a state parameter of a receiver and an apparatus for performing such a method | |
CN116299623A (zh) | 一种城市复杂场景下的ppp和ins紧组合方法与系统 | |
US12013468B2 (en) | System and method for determining GNSS corrections | |
An et al. | Array ppp-rtk: A high precision pose estimation method for outdoor scenarios | |
CN114174870A (zh) | 用于确定描述至少一个特定于环境的gnss曲线的模型的方法 | |
CN114355410B (zh) | 基于并行计算的卫星导航实时精密单点定位系统及方法 | |
CN110618435B (zh) | 观测数据的生成方法与提高vrs稳定性的电文数据生成方法 | |
Skaloud | Reliability of Direct Georeferencing Phase 1: An Overview of the Current Approaches and Possibilities., Checking and Improving of Digital Terrain Models/Reliability of Direct Georeferencing. | |
CN117782080B (zh) | 基于PPP-B2b/INS的实时空基导航系统及方法 |
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 | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20130102 Termination date: 20180329 |
|
CF01 | Termination of patent right due to non-payment of annual fee |