基于UWB技术TW-TOF测距跟踪架构.pdf

跟踪与导航 P400 测距和通讯模块既支持跟踪系统，也支持导航系统。P400 测距和通讯模块是点对点的精 确测距设备。在构建定位和导航同时工作的系统时，常常需要通过另外的无线电系统把位置 信息从移动设备发送给控制中心或者把控制中心所知道的移动点的位置信息发送给移动设 ， P400 测距和通讯模块是一个带有综合数据通信能力的射频系统，因此本征上支持这些跟踪/导 航综合系统。 参照和移动节点 典型的跟踪系统包含有“移动”和“参照”设备或者节点。参照节点的（x,y,z）坐标对于定 位系统来说是已知的，移动节点相对于参照点的位置是计算出来的。当参照节点处于已知和 静态的位置时，他们通常被叫做“锚”。 P400 测距和通讯模块本身并不是一个跟踪系统，也不是一个导航系统。但是作为一个点对点 集成有无线通讯能力（无线通信是用来协调测距交通和传播的参照点位置数据）的射频测距 设备，它为各种不同定位架构的系统提供了最大的灵活性。测距和通讯模块用来测量以下节 点之间的距离： 1. 移动点和移动点 (用于传播参照或者协调相对行为，例如编队和跟随) 2. 移动点和参照点（用于精确定位或漂移校正） 3. 参照点和参照点 （用于在设置特设“锚”，也就是参照点时达到额外的高精确度） 4. 移动的参照点和移动的目标（用于自动车辆安全和态势感知 ） 参照节点处于静止状态时较易理解，实际上任何一个具有准确瞬间动态位置的节点都可以用 来作为参考节点。例如，GPS 卫星就可以作为参照点，但是他们不是静态的。卫星的位置不断 被动态更新并且通过无线方式传送给移动的 GPS 接收器，GPS 接收器根据收到的 GPS “锚”之 间的位置和延时来进行定位。 同样，在一个由测距和通讯模块RCM 辅助的定位系统中，任何具有瞬时精确位置的节点都可 以作为一个相对于具有不太精确的已知位置的邻居节点的参照点。这种“传播参照点”技术 可以扩展跟踪系统的监控范围，但是以传播位置误差为代价。一般来说，系统需要周期性地 通过访问一个知道准确位置的临时静态节点来限制传播误差。 因而在一个采用测距和通讯模块的动态或者特设的跟踪系统中，坐标系统通常建立于 1）临时设置的室外GPS 增强锚， 2）一个具有准确全局位置的中央车辆或者， 3）一个由精确测距和无线通信增强的移动GPS 定位最优组合决定的系统。 在任何情况下，移动节点的位置都不会比参照点的位置更加精确。 测距精度和几何考量 P400 测距和通讯模块提供点对点的，精度为几厘米的测距。通过多个移动节点和参照节点之 间的距离的测量组合就可以计算一个位置。这种解决方法叫做三边定位（相对于三角定位法 中需要测量两个或者多个角度的测量组合进行计算）。 基本的想法就是在一个 2D系统中多个圆的交点： 图1：通过移动节点M 和参照节点 R1，R2 和 R3 之间的距离的组合就可以获得移动节点 M 的位 置 在开发一个基于三边法的跟踪系统时的一个重要考虑就是采用测距和通讯模块进行测距是有 误差的。解算算法把测距和参照点坐标综合起来进行位置估算，取决于节点之间的通道，距 离测量处于泊松分布误差范围为标准偏差 2-10厘米的环空带的交界处，这个误差产生于嵌入 的领先边缘检测算法中的时序抖动和脉冲到达时间测量。 图2：由于参照点相对几何位置的不同，相同测距误差（环空中的厚度）可能产生差别很大的 位置误差的两个例子 以上插图说明参照节点相对于移动节点的几何位置对于定位误差有很大的影响。这种误差几 何放大因子 （GDOP）在所有基于参照点的跟踪和导航系统中很常见。在高级的采用分布式求 解的导航系统中，移动节点根据自己和周围参照节点的相对几何关系瞬时决定其进行测距请 求的“最佳”参照点。在这些系统中，移动节点的处理器必须维持一个“活跃的”周围节点 位置的数据库。 三种类型的求解算法 规划求解算法既可以驻留在一个单一的基站计算机 （集中式架构）中，也可以驻留在每个移 动节点（分布式体系结构）。在任何情况下，规划求解算法都必须考虑到这些圆不会只相交 在一个地方。例如，三个参照距离圆可以相交于 6个不同的点（每个参照距离圆有 2 个交点）。 三种典型的求解方法包括：1）线性最小二乘解算法，2）几何求解法，或3）最