一种定位几何约束UWB多基站测距编码恢复方法、系统
本技术涉及超宽带无线定位、无线测距通信以及测距数据可靠传输,尤其涉及一种定位几何约束uwb多基站测距编码恢复方法、系统。
背景技术:
1、超宽带(uwb)技术凭借纳秒级脉冲特性和高时间分辨率,能够实现厘米级测距精度,常采用双向测距(twr)或双边双向测距(ds-twr)获取标签与多个位置已知基站之间的飞行时间并换算为距离,广泛应用于室内定位、工业定位、仓储物流及移动机器人导航等卫星信号受限场景。在多基站定位网络中,各基站按照分配的响应时隙发送响应消息,标签或其他节点在测距周期结束后获得多个基站对应的测距结果。
2、然而,无线环境中的遮挡、同频干扰、碰撞、接收机暂态失锁以及帧校验失败,均可能使部分基站的测距结果在数据汇聚阶段丢失。现有处理方式通常采用等待下一测距周期重新获取、重新发送缺失数据、对缺失基站重新调度测距,或者在上层采用统一冗余编码提高数据传输可靠性。
3、上述方式忽视了多基站定位中各个测距结果对最终位置解算贡献不等的事实。不同基站相对标签的空间位置不同,基站几何构型不同,同样丢失一条测距信息,所造成的定位几何劣化程度存在显著差异。例如,当剩余基站的视线方向集中在相近方向时,即使保留三个以上测距值,定位几何矩阵仍可能病态,测距噪声会被显著放大;而当剩余基站方向分布良好时,缺失一条测距结果仍可保持可接受的定位精度。若对所有测距结果采用相同冗余等级,会在几何条件良好的测距上消耗不必要的空口资源;若仅依据报文丢包率决定重传,则无法反映各测距结果对位置可观测性的实际贡献。
4、此外,传统差错控制以恢复全部丢失数据为目标,而定位系统真正需要的是获得具有足够几何约束能力的测距集合。当几何约束已满足定位要求时,继续恢复几何贡献较低的缺失测距无法获得与通信开销相匹配的收益。同时,测距结果可能在下一测距周期响应帧中携带,若直接拼接不同历元的数据,易引入时间不一致误差。
技术实现思路
1、本技术的目的在于:为了解决现有技术无法依据各基站测距对定位几何约束的差异化贡献分配编码保护资源,导致冗余开销与定位任务的实际需求脱节的问题,提供一种定位几何约束uwb多基站测距编码恢复方法、系统。
2、本技术的上述目的是通过以下技术方案得以实现的:
3、s1、建立uwb定位网络,uwb定位网络包括一个标签和多个位置已知的基站;标签与多个基站采用基于飞行时间的uwb测距协议,在测距历元k内获得各基站对应的距离,并将同一轮测距赋予统一的测距历元标识;
4、s2、根据标签临时位置估计和基站的坐标,建立测距观测几何矩阵,计算当前有效基站集合的定位几何精度指标;逐个或组合移除基站测距,计算对应的定位几何精度损失,并结合候选测距丢失集合对应的通信丢失概率形成几何通信联合风险,根据几何通信联合风险确定几何关键测距集合和关键丢失集合;
5、s3、对同一测距历元的距离值或者距离残差执行量化,将量化结果映射为有限域源符号;针对几何关键测距集合建立几何定向编码层,针对当前有效基站集合建立全局编码层;根据关键丢失集合对应的几何通信联合风险、候选编码行对关键丢失集合产生的有效可恢复秩增益以及所述候选编码行对应的通信开销,确定几何恢复效用;根据几何恢复效用选择编码行并生成测距编码符号;
6、s4、在uwb通信帧载荷中发送系统测距符号和测距编码符号,并使所述系统测距符号和测距编码符号与产生其对应测距结果的测距历元标识相关联;
7、s5、接收端按照测距历元标识归并已收到的系统测距符号和测距编码符号,基于同一测距单元对应的系统测距符号计算加权定位几何精度指标,若加权定位几何精度指标满足预设定位要求则直接进入定位解算;当加权定位几何精度指标不满足预设定位要求时,从当前全部缺失测距中确定几何关键缺失测距集合,并基于已接收的测距编码符号构建有限域解码方程组;
8、s6、判断有限域解码方程组的有效可恢复秩;当有效可恢复秩满足恢复条件时,对几何关键缺失测距集合对应的有限域源符号进行有限域解码和反量化,并对恢复得到的测距执行有效性校验,校验通过后加入当前接收测距集合;当有效可恢复秩不足且加权定位几何精度指标仍超限时,计算秩亏量并发送能够提高有效可恢复秩的增量测距编码符号;
9、s7、对校验通过的当前接收测距集合中的测距进行位置解算,并根据后续测距历元的基站几何构型、测距质量以及通信状态更新几何定向编码层和全局编码层的编码保护参数,完成测距信息编码的恢复和定位。
10、可选的,所述标签临时位置估计采用以下至少一种方式获得:
11、上一测距历元的有效定位结果;
12、根据上一测距历元的位置、速度和/或加速度预测得到的位置;
13、利用当前能够获得的满足预设粗定位条件的uwb测距结果进行初始定位得到的位置;
14、或者系统启动时预设的初始位置或初始区域中心位置;
15、当系统首次启动且不存在历史有效定位状态时,利用当前能够获得的uwb测距结果执行初始粗定位以获得第一标签临时位置估计,在获得第一标签临时位置估计后再执行定位几何精度评价和编码保护。
16、可选的,步骤s2包括:
17、定位几何精度指标按如下方式构造:
18、在二维定位情况下,设标签临时位置估计为,第i个基站坐标为,根据第i个uwb基站指向标签临时位置估计的测距方向构造观测几何行向量,如下:
19、
20、其中,表示从第i个uwb基站位置指向标签临时位置估计的方向单位行向量;
21、将当前有效基站集合记为s,将s中的各观测几何行向量,按基站编号排列构成测距观测几何矩阵;
22、根据各基站的测距方差建立测距噪声协方差矩阵:
23、
24、其中为第i个基站在测距历元k的测距误差方差,测距误差方差由静态标定值、最近l个测距历元的测距残差方差、信号质量映射值或nlos置信度映射值中的至少一种获得;
25、构造加权定位信息矩阵:
26、
27、其中为加权定位信息矩阵,表示转置;
28、当可逆时,定义用于表征定位误差传播的协方差矩阵:
29、
30、定义定位几何精度指标为:
31、
32、其中表示矩阵的迹;
33、对基于绝对距离且不具有其他独立先验约束的二维定位,参与位置解算的有效uwb基站数量不少于3个且具有非退化平面几何构型;对三维定位,参与位置解算的有效uwb基站数量不少于4个且具有非退化空间几何构型;
34、当有效测距数量低于对应定位模型的最低要求、不满列秩或者不可逆时,将设置为大于预设定位几何精度阈值的失效值;三维定位时,将和扩展为三维坐标并相应扩展的列数;
35、形成几何关键测距集合和关键丢失集合的步骤为:
36、令,则加权定位信息矩阵可写为:
37、
38、当第i个基站测距缺失时,加权定位信息矩阵变为:
39、
40、其中,为加权定位信息矩阵简写形式;为第i个基站测距缺失时的加权定位信息矩阵;
41、定义第i个基站对应的几何信息损失灵敏度为移除该测距前后协方差迹的增量:
42、
43、根据矩阵降秩求逆关系,在分母为正且远离零的情况下,几何信息损失灵敏度由加权定位信息矩阵的一次逆矩阵结果直接计算为:
44、
45、当公式(9)的分母小于等于零或绝对值低于稳定性阈值时,将设置为预设极大值;
46、对于由一个或多个基站组成的候选测距丢失集合e,定义候选测距丢失集合对应的几何超限损失为:
47、
48、其中,表示第k个测距历元的当前有效基站集合;表示从当前有效基站集合中移除候选测距丢失集合e后的剩余基站集合;表示由剩余基站形成的加权定位几何精度指标;表示预设加权定位几何精度阈值;
49、将候选测距丢失集合e对应的通信丢失事件定义为:集合e中的全部系统测距符号在同一测距历元内均未被目标接收节点成功获得,而不限定集合e之外的其他系统测距符号是否同时发生丢失;
50、根据最近l个测距历元的实际接收状态统计候选测距丢失集合e的通信丢失概率:,其中,,表示第τ个测距历元实际发生系统测距符号丢失的基站集合;表示示性函数,当时取值为1,否则取值为0;
51、当历史统计样本不足,且近似认为各基站系统测距符号之间相互独立丢失时,通信丢失概率按照下式近似计算:
52、
53、其中,表示第i个基站的系统测距符号在当前统计窗口中的接收失败概率;
54、将通信丢失概率与几何超限损失相乘,定义候选测距丢失集合e对应的几何-通信联合风险:
55、
56、当满足下列条件之一时,将候选测距丢失集合e加入第k个测距历元对应的关键丢失集合库:
57、
58、或者:
59、
60、其中,表示预设几何-通信联合风险阈值。
61、可选的,步骤s3包括:
62、将量化结果映射为有限域源符号的方法为:
63、设第i个uwb基站在测距历元k对应的当前测距结果为,参考距离为,量化步长为δ,当采用测距残差编码时,形成有符号量化值:
64、
65、其中表示第k个测距历元,第i个基站的有符号量化值;表示四舍五入取整函数;表示量化步长;
66、参考距离为上一已确认有效测距结果、基于历史定位状态预测得到的测距结果或者预设基准测距结果中的至少一种;当采用测距残差编码时,为参考距离设置参考基准标识rid,使编码节点和接收节点能够根据相同rid确定相同的参考距离;
67、通过固定偏移映射、补码映射或者预设查表映射,将有符号量化值可逆地映射至有限域f中的有限域源符号,其中有限域f为或;并使预设允许量化区间中的不同有符号量化值映射为不同的有限域元素;当量化结果超出允许量化区间时,采用扩大量化字宽、调整量化步长、切换绝对距离编码或者发送量化溢出标志中的至少一种方式处理;
68、将同一测距历元对应的有限域源符号构成有限域源符号向量:;
69、第r个测距编码符号按照下式生成:
70、
71、其中表示第k个测距历元中,第r个测距编码符号;表示第r个编码行中,第i个基站对应的编码系数;表示或;
72、几何定向编码行的非零编码系数至少覆盖几何关键测距对应的有限域源符号列;对于编码节点当前未实际持有的有限域源符号,对应编码系数设置为零;全局编码行覆盖编码节点当前实际持有的当前有效基站有限域源符号;
73、对于当前候选缺失模式,将需要优先恢复的几何关键缺失测距集合记为e,将除集合e之外同时存在的其他未知有限域源符号集合记为f,定义集合e相对于集合f的有效可恢复秩为:,其中,()表示在有限域f上计算矩阵秩;符号表示仅保留集合对应的列;
74、对候选编码行,定义该候选编码行针对关键丢失集合e的有效可恢复秩增益为:
75、
76、设表示发送候选编码行对应测距编码符号产生的通信代价,通信代价为预计空口字节数、占用uwb时隙长度或者预计发送时长中的至少一种,且;利用几何-通信联合风险对候选编码行的有效可恢复秩增益进行加权,定义候选编码行的几何恢复效用为:
77、
78、其中,表示候选编码行的几何恢复效用;表示第k个测距历元的关键丢失集合库;表示候选测距丢失集合e的几何通信联合风险;表示对应候选缺失模式下除关键丢失集合e之外的其他未知有限域源符号集合;
79、从候选编码行集合中选择几何恢复效用最大的候选编码行作为当前最优编码行:
80、
81、每增加一个编码行后,重新计算各关键丢失模式对应的有效可恢复秩;当全部需要保护的关键丢失模式均满足预设可恢复条件,或者达到预设编码通信资源预算时,停止增加编码行;
82、关键丢失集合e对应的可恢复条件为:;
83、当不存在除关键丢失集合e以外的其他未知有限域源符号,即f=时,可恢复条件退化为:
84、
85、其中表示关键丢失集合e的基站数量。
86、可选的,步骤s4包括:
87、编码节点通过以下至少一种方式获得同一测距历元标识eid和基站集合版本标识asv下的多个有限域源符号:监听其他uwb基站发送的携带系统测距结果的uwb通信帧;接收其他uwb基站或uwb标签主动发送的系统测距结果;或者通过uwb标签、uwb基站、网关或上位处理节点之间的数据转发获得系统测距结果;
88、编码节点建立源符号有效掩码vm,源符号有效掩码vm用于标识编码节点生成当前测距编码符号时实际持有的有限域源符号,编码节点未实际持有的有限域源符号对应编码系数设置为零;
89、系统测距符号和测距编码符号对应的uwb业务载荷至少包括:
90、测距历元标识eid,用于标识产生被编码测距结果的实际测距历元;
91、基站集合版本标识asv,用于标识当前参与定位的基站集合以及对应的基站坐标版本;
92、编码层标识,用于区分几何定向编码层和全局编码层;
93、编码行标识cid,用于使接收节点确定或重构对应编码系数行;
94、源符号有效掩码vm;
95、量化参数标识qid,用于标识量化步长、有限域类型以及源符号映射方式;
96、当某一测距结果需要在当前测距历元的结束消息接收后才能完成计算时,测距结果对应的系统测距符号和测距编码符号在完成测距结果计算后的最早可用uwb通信机会发送;
97、最早可用uwb通信机会包括当前测距历元结束后的专用数据帧、预留恢复时隙、下一测距历元中的响应消息业务载荷、下一测距历元中的结束消息业务载荷或者其他后续uwb通信帧;
98、在实际承载系统测距符号或测距编码符号的uwb通信帧的任意一个通信周期,其携带的eid均保持为产生对应测距结果的实际测距历元标识。
99、可选的,步骤s5包括:
100、接收节点统计同一测距历元标识eid和基站集合版本标识asv下直接接收到的系统测距符号集合,计算;
101、若,则不执行测距恢复,直接将送入定位解算器;表示判定测距集合是否有效的最大临界值;表示测距集合的加权定位几何精度指标;
102、若,则确定当前全部缺失有限域源符号集合,并从中确定几何关键缺失测距集合,将其他非关键缺失有限域源符号集合定义为:
103、
104、对同一eid和asv下已接收的测距编码符号,根据对应编码行标识cid、源符号有效掩码vm以及编码层标识重建有限域编码矩阵,并在有限域f上计算:
105、
106、当时,判定集合中的几何关键缺失源符号相对于集合中的其他未知源符号具有唯一可恢复性;
107、接收节点从编码符号值中消除已知有限域源符号的贡献,并通过有限域高斯消元或者其他有限域线性方程求解方式恢复至少一个几何关键缺失有限域源符号;
108、当不存在其他非关键未知源符号,上述恢复条件退化为:
109、
110、每恢复一个或一组几何关键缺失有限域源符号后,对有限域源符号进行反量化及有效性校验,将校验通过的恢复测距加入当前接收测距集合,并重新计算加权定位几何精度指标;
111、当更新后的加权定位几何精度指标满足:时,停止对剩余非关键缺失测距执行恢复。
112、可选的,步骤s6包括:
113、将几何关键缺失测距集合对应的有限域源符号集合记为,将当前除集合以外的其他未知的有限域源符号集合记为;
114、根据有限域解码方程组对应编码矩阵中和对应的列,计算集合相对于集合的有效可恢复秩;
115、当时,对至少一个几何关键缺失有限域源符号进行有限域解码和反量化,对恢复得到的测距执行有效性校验;
116、将校验通过的恢复测距加入当前接收测距集合,并重新计算加权定位几何精度指标,直至所述加权定位几何精度指标满足预设定位要求;
117、当有效可恢复秩不足且加权定位几何精度指标仍不满足预设定位要求时,根据集合中的有限域源符号数量与当前有效可恢复秩之间的差值确定有效秩亏量,生成恢复请求,并由编码节点发送能够提高所述有效可恢复秩的增量测距编码符号,而不重新执行所述几何关键缺失测距对应的完整飞行时间测距交互;
118、所述有效秩亏量按照下式计算:
119、
120、其中,表示第k个测距历元的有效秩亏量,表示几何关键缺失有限域源符号数量,表示候选增量编码行加入之前的当前有效可恢复秩;
121、接收节点生成恢复请求,所述恢复请求至少包括测距历元标识eid、基站集合版本标识asv、几何关键缺失源符号掩码、其他未知源符号掩码以及当前有效可恢复秩;
122、编码节点根据恢复请求生成候选增量编码行,并判断候选增量编码行加入当前有效编码矩阵之后的有效可恢复秩;仅当候选增量编码行满足时,采用所述候选增量编码行,其中,表示候选增量编码行加入之前的当前有效可恢复秩,表示候选增量编码行加入之后的有效可恢复秩;
123、编码节点发送能够使降低至零所需的增量测距编码符号,或者在加权定位几何精度指标已经满足预设定位要求时提前停止增量编码。
124、可选的,步骤s7包括:
125、根据下一测距历元的基站构型和通信状态,更新几何定向编码层与全局编码层的编码保护参数,具体如下:
126、针对包含个待保护有限域源符号的关键丢失集合,几何定向编码层配置个编码行,并使个编码行在关键丢失集合对应列形成具有任意行满列秩性质的有限域编码子矩阵;有限域编码子矩阵采用范德蒙德型生成矩阵、里德-所罗门型生成矩阵或者其他满足最大距离可分性质的有限域编码矩阵;
127、在编码符号相互独立接收且单个编码符号成功接收概率为的情况下,给定允许恢复失败概率ε,满足目标恢复可靠度的最小发送编码符号数量为:
128、
129、其中,表示满足目标恢复可靠度的最小发送编码符号总数量,表示待保护的关键有限域源符号数量,表示单个编码符号的无线链路成功接收概率,表示允许的恢复失败概率;表示个编码符号全部成功接收的概率;实际冗余编码符号数量为:。
130、可选的,所述方法还包括:
131、当uwb标签设置有惯性测量单元或者能够根据历史定位状态获得速度和加速度估计时,根据第k个测距历元的位置估计、速度估计、加速度估计和测距历元时间间隔,预测第k+1个测距历元对应的标签临时位置:
132、
133、其中表示第k+1个测距历元的预测标签位置,即位置估计;表示测距历元时间间隔;
134、根据预测标签临时位置预先构建第k+1个测距历元对应的测距观测几何矩阵和加权定位信息矩阵,并预测第k+1个测距历元的几何关键测距集合以及几何-通信联合风险,以在uwb标签进入预测几何敏感区域之前调整相应关键测距的编码保护参数。
135、一种定位几何约束uwb多基站测距编码恢复系统,所述系统包括:
136、uwb标签、多个位置已知的uwb基站以及至少一个处理节点;
137、uwb标签和多个uwb基站被配置为执行基于飞行时间的uwb测距,并生成带有测距历元标识eid的多个基站测距结果;
138、处理节点包括处理器和存储器,存储器存储有由处理器执行的程序,处理器执行程序时被配置为:
139、根据标签临时位置估计、基站坐标以及测距质量建立测距观测几何矩阵和加权定位信息矩阵,根据候选测距丢失造成的定位几何精度损失与对应通信丢失概率确定几何-通信联合风险;
140、根据几何-通信联合风险确定几何关键测距集合和关键丢失集合,并将同一测距历元的多个测距结果或测距残差映射为有限域源符号;
141、根据关键丢失集合对应的几何-通信联合风险、候选编码行对应的有效可恢复秩增益以及通信开销确定候选编码行的几何恢复效用,并根据几何恢复效用选择编码行形成几何定向编码符号和全局编码符号;
142、按照eid和基站集合版本标识asv归并系统测距符号和测距编码符号,在当前接收测距集合不满足预设定位几何精度要求时确定几何关键缺失有限域源符号集合;
143、根据所述几何关键缺失有限域源符号集合相对于其他未知有限域源符号集合的有效可恢复秩判断所述几何关键缺失有限域源符号是否具有唯一可恢复性,在具有唯一可恢复性时执行有限域解码,在不具有唯一可恢复性时根据有效秩亏量生成增量编码请求;
144、对恢复得到的测距进行有效性校验,并利用使加权定位几何精度指标满足预设定位要求的当前接收测距集合进行位置解算。
145、本技术提供的技术方案带来的有益效果是:
146、1、本技术将冗余保护对象从“全部测距数据”转变为“缺失后会使定位几何精度指标超限的测距数据”,利用基站空间构型对编码保护进行定向分配,使编码冗余直接服务于位置可观测性。
147、2、本技术采用几何定向编码层和全局编码层的分层结构,并根据几何关键缺失源符号相对于其他未知源符号的有效可恢复秩评价关键测距的唯一可恢复性,避免在全局编码方程包含其他未知源符号时仅依据关键列子矩阵满秩而产生错误恢复判断,从而提高测距编码恢复的数学一致性和可靠性。
148、3、本技术在接收端先计算缺失后的定位几何精度指标,仅当几何指标超限时启动解码;恢复过程中一旦定位几何重新达标即停止,因此允许保留对定位影响较小的非关键数据缺失,减少不必要的数据恢复。
149、4、本技术通过eid和asv将系统测距符号与编码符号绑定到同一测距历元和同一基站集合版本,可避免把不同时间或者不同基站配置下的距离误作为同一个测距向量进行解码和定位。
150、5、本技术在几何关键缺失源符号的有效可恢复秩不足时,根据关键源符号数量与有效可恢复秩之间的差值确定有效秩亏量,并仅发送能够提高所述有效可恢复秩的增量测距编码符号,不要求重新执行已经完成的飞行时间观测,从而减少因测距结果传输丢失造成的重复测距通信。
151、6、本技术的编码与恢复过程可作为uwb通信协议业务载荷层的增强机制叠加在现有多基站twr、ds-twr或其他飞行时间测距流程之上,不要求改变uwb射频前端的基本测距原理,便于在现有uwb定位硬件上通过软件升级实现。
152、7、本技术通过把测距协方差引入信息矩阵,使编码保护不仅受基站空间构型影响,还受实际测距质量影响;通过矩阵降秩关系直接计算单基站几何信息损失灵敏度,可避免针对每个基站重复执行完整矩阵求逆,适于嵌入式节点在线更新。
153、8、本技术进一步将关键丢失组合的通信丢失概率与定位几何超限损失构成几何-通信联合风险,并利用所述联合风险对候选编码行的有效可恢复秩增益进行加权,形成单位通信开销下的几何恢复效用,使编码行的生成直接受到定位任务风险、未知源符号耦合关系及通信资源开销共同约束,而非采用固定或随机冗余。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com