专利名称：用于精确相对定位的gps测量值的最佳编码的制作方法
技术领域：
本发明总体上涉及用于编码GPS测量值的系统和方法，且更具体地涉及用于编码车辆通信系统中的精确相对定位用的GPS测量值的系统和方法，其中，所述系统采用 Huffman编码器。
背景技术：
多个车辆的短基线精确相对定位具有很多民用应用。通过使用实时的相对GPS信 号，车辆能够建立配备有GPS接收器和数据通信信道(例如，专用短程通信(DSRC)信道) 的周围车辆(车辆至车辆目标地图)的相对位置和速度的分米以下水平的准确性。该协作 安全系统能够以与雷达系统相同的方式提供位置和速度信息。为了进行精确相对定位，车辆需要传送其原始GPS数据，例如代码范围、载波相位 和多普勒测量值。在涉及大量车辆的拥挤交通情形下，这样做所需的带宽将成问题。The Radio Technical Commission for Maritime Service SpecialCommittee 104(RTCM SC104)中所定义的数据格式包括不想要的冗余性。例如，信息类型#1 (L1C/A代 码相位校正)用0. 02米分辨率一致地量化校正值。伪距测量值因而被表示在士0. 2X215 米的范围内。然而，伪距测量值通常限于大约士 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可以在下文进一步描述。令&，&，...，乂1 为1(个车辆。令&是 第i个车辆的状态，包括在地心地固坐标(ECEF)中的位置和速度。令Xh是主车辆12的状 态，其中，KHSK。令X是卫星的状态，包括在ECEF坐标中的位置和速度，其可以通过由 第j个卫星传送的星历表消息确定。图3示出了用于精确求解车辆之间的相对位置和速度矢量的流程图60。流程图 60包括空中(OTF)联合定位及模糊度确定模块62，其从各个源接收信息，包括在框64处的 车辆数据、在框66处的车辆独立位置、在框68处的卫星星历表和在框70处的GPS观测值 的双重差分，如下所讨论的。在框72，模块62输出其它车辆的位置速度和模糊度。要注意 的是，需要一个车辆的绝对坐标。在仅仅包括移动车辆的系统中，移动参考坐标简单地使用 独立定位模块来估计，以提供参考基准坐标的近似坐标。使用用于短基线的双重差分载波相位测量值来实现高定位精度。载波相位测量值优于代码测量值，因为它们能够被测量为优于0.01 λ，其中λ是载波信号的波长，载波信 号对应于毫米精度且比其代码对等物受多路径的影响更少。然而，载波相位通过循环数的 整数模糊化，所述循环数必须在车辆操作期间被确定。令主车辆Xh是移动参考站。令bih是主车辆Xh和远程车辆Xi之间的基线。载波 相位的以下双重差分测量值、代码和多普勒测量值可以写成
(1)H(XH，bih)是取决于移动主车辆Xh和基线bih的测量矩阵，λ是载波的波长，N是模 糊度双重差分的矢量，Vih是未建模测量噪音。在不丧失一般性的情况下，假设等式(1)被 标准化，即，Vih的协方差矩阵是单位矩阵。流程图60的核心是空中(OTF)联合定位及模糊度确定模块62。在模块62中，采 用(6+J-1)维状态跟踪滤波器来估计三个位置和三个速度分量以及J-I浮动模糊度双重差 分如下
(2)其中
是H(XH，bih)和联合状态
的扩展。 注意到矩阵应对主车辆Xh和基线bih的变化不是非常敏感。借助于可获 得的基线的过程等式，使用先前时刻的主车辆Xh和预测估计值.δ,,通常就足够了。因而，当 可获得值d时，通过下述滤波可以获得基线bih的更好的估计。令基线bih的过程等式为 其中w表示未建模噪音。在等式(3)中，f是表示基线动态模型的函数。动态模型的一些候选是恒定速度 模型(CV)或恒定转向模型(CT)。在先前循环的基线δ,7,的预测邻域中线性化等式(3)且包 括模糊度N的双重差分得出 其中，I是单位矩阵， 注意到OTF联合滤波过程可以写成下文所述的算法1。在等式(1)中，测量矩阵H(XH，bih)对上述单基线定位方法收敛至正确解起到重要 的作用。几何精度因子(GDOP)(即，[H(XH, bjr1)影响对基线bih的估计的质量。可以确 认⑶OP取决于对基线bih而言共用卫星的数量和共同卫星的星座。例如，当远程车辆和主 车辆之间的可见共用共同卫星在天空靠拢在一起时，几何构型是弱的且GDOP值高。当远程 车辆和主车辆之间的可见共用共同卫星相距较远时，几何构型是强的且⑶OP值低。因而， 低GDOP值表示由于卫星之间的更宽角间隔引起的更好的基线精度。极端情况是在共用卫 星数量少于4时⑶OP无限大。图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)类似地，基线具有两个解。可以确认，两个解的质量是不同的。目标是寻找最 佳解。如图4所示，由于建筑物94引起的阻挡，基线bAC的估计值的质量由于观测到少于四 个共用卫星(PRN1，9)而降级。另一方面，从基线bAB和bAC推出的基线bAC比基线bAC的直 接估计值更好。来自于图4的构思可以通过引入图表G来概括，其中顶点表示车辆而边缘表示两 个顶点之间的基线。令边缘的权重为两个车辆之间的基线的GD0P。目标是寻找生成树，即 选择形成跨越每个顶点的树的G的边缘，其中主车辆被指定为根，从而从根到所有其它顶 点的路径具有最小GD0P。图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中计算基线以获得最小⑶OP的步骤可以通过适合于本文所述目的 的任何算法执行。第一算法(称为算法1)基于单基线精确定位。令联合状态的先前估计 值1)且其协方差矩阵 -l);双重差分d ；接收器的GPS时标tK ；卫星星历表E ；系统的动 态等式⑴；测量等式⑵；等式⑶中噪音项w的协方差矩阵Q ；以及等式⑵中噪音项ν 的协方差矩阵R。在时间t联合状态和协方差矩阵户ω的更新估计值可以求解如下1.使用等式(1)计算预测值 如下 且 2.计算修正误差(innovation error)如下 其中 3.计算修正协方差 4.计算卡尔曼增益为 5.输出更新估计值和协方差矩阵合 多个车辆的精确相对定位也可以通过以下算法(称为算法2)确定。1.建立车辆的加权图表G，其中，每个车辆是顶点且如果共用观测卫星的数量大 于或等于四那么在两个车辆之间增加边缘。令根表示主车辆。2.边缘的权重等于由两个车辆观测的共同卫星的几何精度因子(⑶0Ρ)，即，对于 顶点i和j之间的边缘权重而言，等式(1)中的 3.使用动态编程(算法3的修改Bellman-Ford算法或算法4的Dijkstra算法) 来寻找生成树，使得来自于任何其它节点的路径具有用于定位的最佳卫星几何构型(最小 GD0P)。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|l<i≤I Vl }、边缘E= {ek|l≤k≤|E|}、以及 边缘的权重{wk 11≤k≤IE I}；顶点源H。确保生成树I^PG:1.开始for循环对于顶点集合中的所有顶点V，进行2.开始 if 条件如果 ν 是源，那么(if ν is the source then)3.令 cost(v)为 0。4.否则5.令 cost(v)为①。6.结束 if 条件(end if)7.令 predecessor (ν)为空。8.结束for循环9.开始for循环对于i从1至|V卜1，进行10.开始for循环对于E中的每个边缘ek，进行11.令u为e的源顶点。令ν是ek的目标顶点。12.开始 if 条件如果 cost (ν)小于 max(wk，cost (U))，那么
13.令 cost (ν) = max (wk，cost (u)) ο14.令 predecessor (ν) =u。15.结束if条件16.结束for循环17.结束for循环18.针对所有顶点使用predecessor (ν)来建立生成树Τ。算法4是修改的Dijkstra算法给定图表G，其中顶点V= {Vi|l≤i≤I Vl }、边缘E= {ejl≤k≤ |E|}、以及 边缘的权重{wk 11≤k≤E I}；顶点源H。确保生成树I^PG:1.开始for循环对于顶点集合中的所有顶点V，进行2.开始if条件如果ν是源H，那么3.令 cost(v)为 0。4.否则5.令 cost(v)为①。6.结束if条件7.令 predecessor (ν)为空。8.结束for循环9.令集合Q包含V中的所有顶点。10.开始for循环对于Q非空，进行11.令u是Q中具有最小成本的顶点。从Q去除U。12.开始for循环如果对于u的每个邻居V，进行13.令 e 是 u 禾口 ν 之间的边缘。令 alt = max (cost (U)，weight (e))。14.开始if条件如果alt < cost (ν)，那么15. cost (ν) = alt16.令 predecessor (ν)为 U。17.结束if条件18.结束for循环19.结束for循环20.针对所有顶点使用predecessor (ν)来建立生成树Τ。GPS测量值通过GPS接收器的位置和速度的本征矢量相关联，其可以表示如下。令X是包括ECEF坐标中的位置和速度的六维本征状态矢量。令C是包括ECEF坐 标中的卫星的位置和速度的卫星星座，其可以通过由卫星传送的星历表消息确定。令GPS 测量的量0包括来自于卫星的接收器的代码范围、载波相位和多普勒偏移。因而，测量等式 可以写为0 = h、X,p,/],C、+ v(6)其中，β是主接收器时钟误差，々是β的变化率，以及ν是用于GPS测量值的未建 模噪音，包括由电离层和对流层折射、卫星轨道误差、卫星时钟偏移、多路径等引起的偏差。图7是包括独立绝对定位模块132的系统130的框图，独立绝对定位模块132接收框134处的卫星观测值和框136处的卫星星历表。来自于定位模块132的预测观测值和 卫星观测值提供给加法器138，其中，由编码器140编码信号之间的差。在框142，来自于编 码器140的编码信号和来自于定位单元132的绝对定位速度信号作为车辆绝对定位和速度 信号和压缩修正误差提供。独立绝对定位模块132监测测量值(包括代码范围、载波相位和多普勒偏移)的 输入、卫星星座C的输入、以及车辆数据(例如，车轮速度和偏航速率)。模块132产生GPS 接收器的绝对位置和速度X。模块132也产生由函数h表示的预测GPS测量值0
(7)因而，修正误差e可以定义为
(8)可以确认，修正误差矢量具有两个属性。分量彼此不相关，且对于每个分量，偏差 远小于GPS测量值0的对等物。因而，标准数据压缩方法(例如但不限于矢量化或Huffman 编码)可以应用于修正误差e且实现良好的压缩性能。图8是示出了压缩模块的反向操作的框图150且示出了如何从来自于无线收音机 模块的接收压缩数据恢复GPS测量值的步骤。具体地，在框152处的压缩修正误差提供给 解码器154，且框156处的车辆绝对位置和速度信号以及框158处的卫星星历表信号提供给 计算预测观测模块160。在框164，来自于解码器154和观测模块160的信号由加法器162 相加以提供卫星观测值，例如代码范围、载波相位和多普勒频率。令GPS接收器的绝对位置和速度的估计值为义。压缩修正误差被解码以获得对应 修正误差e。可以确认，预测测量值0可以从GPS接收器的绝对位置和速度的估计值Z和卫 星星座C计算为
(9)因而，恢复的GPS测量值可以计算为
(10)GPS测量值与时间高度相关。这使得它们非常适合于使用本征状态矢量X的预测 模型来压缩。令在时刻t时本征状态的过程等式为X(t+1) = f (X(t))+w (11)其中，f是主车辆的系统过程函数(例如，恒定速度模型或恒定转向模型)，其中 GPS接收器安装在车顶上且w是过程等式中的未建模噪音。等式(11)中残差非常适合于通过编码当前状态矢量和来自于先前时刻的预测状 态矢量之间的差来压缩。图9是所提出的压缩方案的系统170。独立位置及速度估计器172监测时刻t时 的GPS测量值的输入o(t)和来自于先前时间t-i的本征状态矢量的预测值1(0 ,且产生 本征状态矢量的新估计值χω。观测预测模型模块174使用等式(6)计算观测预测值0(0。 Huffman编码器I模块176基于所导出的Huffman树使用可变长度编码来编码来自加法器 184的输入0(t)和模型预测值(5⑴之间的差。单位延迟模块178存储先前本征状态矢量 X{t-\)。状态预测模型180计算本征状态的预测值。Huffman解码器II模块182基于Huffman树使用可变长度编码来编码来自于加法器186的本征状态矢量1(0和模型预测值 之间的差。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的当前和先前估计值之间的差大于阈值时，也 发送ι-帧。A-帧包含非测量数据，例如卫星列表、数据质量指示器等。 A-帧仅在启动时和在 内容变化时传输。最经常传输的帧是D-帧和M-帧。在如下的意义上D-帧类似于在MPEG音频编码 标准中使用的P图片帧它们参考先前编码的样本进行编码。D-帧中的时间序列差使用在 等式(11)中表示的车辆动态模型。每个D-帧包含本征状态X的当前和先前估计值之间的 Huffman编码差。M-帧包括GPS时标以及测量值0和预测值之间的Huffman编码差。每 当接收新的GPS测量值时，M-帧被发送，且单独的帧针对M-帧的Ll和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= {ai，a2，...，an}，其为具有大小η的符号字 母表。然后，令P= {p1; P2，…，P1J，其为(正)符号频率的集合，即，Pi = frequency ( )， 1彡i彡η。通过建立Huffman树来产生代码C (A，P) = Ic1, c2，. . .，cj，其为(二进制) 码字的集合，其中，Ci是 的码字，1彡i彡η。图13是用于编码GPS数据的算法的流程图230。在决策菱形块232，一旦从GPS装 置接收新数据，过程就开始，且如果没有接收数据，那么过程在框234结束。然后，在框236 收集GPS数据0，所述GPS数据包括来自于第j个卫星X^的伪距民、多普勒偏移A和载波 相位Φ」，第j个卫星Xj属于集合C = {X」11彡j彡J}，其中J为可见卫星的数量。值Xj包 括ECEF坐标中第j个卫星的三维位置。所述算法然后在决策菱形块238确定卫星地图是否已经变化，且如果是，所述算 法在框240产生A-帧。具体地，如果卫星星座C的标识(S卩，PRN)从先前时刻变化，那么 产生A-帧以编码观测卫星PRN的列表。所述帧包括32位地图，其中，取决于具体卫星的存在数据，每一位是真或假。所述算法然后在框242估计车辆的独立位置和速度。在估计独立位置及速度 模块中，使用卡尔曼滤波器通过测量值0序列来估计本征状态矢量X。令本征状态矢量 1二0^，2，夂久2,/ ，力)分别表示ECEF坐标中的三维位置矢量、ECEF坐标中的三维速度矢 量、接收器时钟误差和接收器时钟误差变化率的链接矢量(concatenated vector) 0等式 (6)在邻域X*处的线性化系统可以写成X(t+1) = FX(t)+U!+w (12)其中，F是关于本征状态矢量X和非线性项U1 = f(X*)_FX*的Jacobian矩阵。第j个卫星的等式(6)的测量值可以扩展成Rj = ρ j+c β +νΕλ Oi = ρ j+c^ + ANj+VodS) 对于j = 1，. . .，J，其中ρ J是接收器和第j个卫星之间的几何距离，一是投射到 从接收器到卫星的方向上的第j个卫星的速度矢量的投影，c表示光速，λ和f分别是载波 信号的波长和频率，VE, Vtc和Vd分别是伪距、载波相位和多普勒偏移的未建模测量噪音，且 Xj> Yj和Zj是ECEF坐标中的第j个卫星的三维位置。注意，量P ^和一取决于本征状态矢量X的矢量。换句话说，等式(13)包括关于 本征状态矢量X的非线性等式。这些量对本征状态矢量X的变化不是非常敏感。在接收器 动态可用时，使用先前时刻的预测估计值X作为线性化邻域X*的中心且用之取代等式(13) 中的本征状态矢量X通常就足够了。因而，当民、Φ」和Dj可用时，可以通过在下文详述的 算法5中所述的滤波方法来获得本征状态矢量X的更好估计值。等式(13)可以在邻域X*中线性化为Oj = HjX+u^.+VJ (14)其中，Oj = [Rj, Φ J5Dj.]t，Hj是关于本征状态矢量X和非线性项u2j = h (X*) -HjX*的 等式(13)的Jacobian矩阵。因而，估计独立位置及速度模块的关键步骤可以在算法5中 概述。所述算法然后在决策菱形块244确定当前状态估计值X(t)和先前状态估计值 x(t-l)是否大于阈值Τ。如果当前状态估计值X(t)和先前状态估计值X(t-1)之间的差大 于阈值T，那么在框248产生I-帧。I-帧编码当前状态估计值X (t)，包括接收器的ECEF位 置和速度。否则，在框246产生D-帧以使用Huffman码字字典来编码差X (t)-X (t_l)。下一步骤是在框250计算测量值的建模残差e = 0-h(X) (15)然后，在框252，测量建模残差通过产生M-帧使用Huffman码字字典来编码。在框 254的最后步骤中，所有产生的帧传输给下部UDP层196。算法5，绝对位置更新给定本征状态的先前估计值1)且其协方差矩阵户( -1)；测量值0(t)；接收器 的GPS时标tK ；卫星星历表E ；系统动态等式(4)；测量等式(6)；等式(4)中的噪音项w的协方差矩阵Q ；等式(6)中的噪音项ν的协方差矩阵R。在时间t接收器的绝对位置和速度的更新估计值Χ( )。1.计算预测值 2.开始for循环对于所有j，1≤j≤J，进行3.接收第j个卫星的卫星星历表。4.计算第j个卫星的ECEF位置义=,力，Zj工和速度矣=[iy,夂,。5.计算
是接收器的ECEF位置的预测值。6.使用等式(7)计算H」。 7.结束for循环8.计算 H= [H/，…，Η/]τ。9.使用等式(5)计算修正误差，即e = 0(t)-h(X)10.计算修正协方差S =//戶Λ。11.计算卡尔曼增益尺= M7^T1。12.输出更新估计值夕=文+尺6和协方差矩阵户=(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测量信息之间的第一差信号； 编码所述第一差信号以提供第一编码输出；使用状态预测模型以通过使用所估计本征状态矢量来产生预测本征状态矢量； 提供所估计本征状态矢量和所述预测本征状态矢量之间的第二差信号；和编码所述第二差信号以产生第二编码输出。
全文摘要
本发明涉及用于精确相对定位的GPS测量值的最佳编码。编码车辆卫星通信系统中的GPS测量值的系统。系统包括独立位置及速度估计器，其从在第一时间接收的GPS测量值和先前时间的本征状态矢量的预测值来产生估计本征状态矢量。系统还包括观测预测模型，其从估计本征状态矢量计算观测预测值。系统还包括第一差分器和第一Huffman编码器，第一差分器提供观测预测值和GPS测量值之间的差，第一Huffman编码器从所述差提供编码输出。系统还包括状态预测模型和第二差分器，状态预测模型提供预测本征状态矢量，第二差分器提供估计本征状态矢量和预测本征状态矢量之间的差。第二Huffman编码器编码来自于第二差分器的差。
文档编号G01S19/35GK101846747SQ20101014547
公开日2010年9月29日 申请日期2010年3月29日 优先权日2009年3月27日
发明者S·曾 申请人:通用汽车环球科技运作公司