用于UWB双天线TAG链路的目标跟随控制方法、装置及系统与流程

摘要: 本发明涉及超宽带uwb定位、测距、测角、射频链路分集与移动载具跟随控制,尤其涉及一种用于uwb双天线tag链路的目标跟随控制方法、装置及系统。背景技术:1、当t...
用于UWB双天线TAG链路的目标跟随控制方法、装置及系统与流程

本发明涉及超宽带uwb定位、测距、测角、射频链路分集与移动载具跟随控制,尤其涉及一种用于uwb双天线tag链路的目标跟随控制方法、装置及系统。

背景技术:

1、当tag佩戴在人体上时,其姿态会随运动不断变化。这会导致tag上的单天线与基站天线的极化方向不匹配,造成高达10~20db的信号衰减,从而引起报文丢包率急剧升高,人体的遮挡效应会使天线方向图出现信号较弱的空洞。当tag转动到特定角度时,信号能量会显著下降,导致信道脉冲响应失真,进而引发测距异常和基站解算角度的抖动。

2、传统的单天线方案没有冗余备份,一旦当前天线的极化方向处于劣势,通信链路便会中断,且没有恢复手段,最终表现为机器人跟随方向跳变、距离不稳定或直接丢失目标,在移动跟随场景中,tag的方向快速变化,信号质量波动剧烈,仅依靠tag端自身的信号质量评估来切换天线,可能会因姿态的快速改变而做出错误的切换决策,导致数据抖动。

3、此外,现有uwb跟随方案多将双天线或阵列设置在基站端以实现aoa/pdoa测角,现有双天线标签方案多用于测角消歧,现有八边形或分形uwb天线方案多关注单一天线结构的小型化和带宽性能。上述方案并未同时解决小型有源uwb tag在佩戴姿态快速变化时的极化失配、双天线切换引入的通道时延差异以及移动载具跟随控制的置信度处理问题。

4、综上所述,需要一种用于uwb双天线tag链路的目标跟随控制方法及系统来解决现有技术中所存在的不足之处。

技术实现思路

1、针对现有技术中小型uwb tag在佩戴姿态变化、极化失配和移动跟随场景下容易出现丢包、测距跳变和测角抖动的问题,本发明提供一种用于uwb双天线tag链路的目标跟随控制方法、装置及系统。

2、为实现上述目的,本发明提供如下技术方案:一种用于uwb双天线tag链路的目标跟随控制方法,包括以下步骤:

3、步骤s1:uwb双天线tag通过第一板载uwb天线和第二板载uwb天线分别与设置于移动载具侧的uwb基站进行uwb测距和/或测角通信,并在uwb报文或控制报文中携带当前天线id;

4、步骤s2:基站或uwb双天线tag获取与所述第一板载uwb天线和第二板载uwb天线对应的链路质量参数,并根据所述链路质量参数从两路天线对应的测距测角数据中选择有效输出数据,或者确定当前工作天线;

5、步骤s3:基站或uwb双天线tag根据所述天线id调用与当前天线对应的校准补偿参数,对tof测距值、pdoa/aoa测角输入或定位融合结果进行补偿;

6、步骤s4:跟随控制器根据补偿后的距离、方位角和置信度生成移动载具的速度控制量和转向控制量;

7、步骤s5:当所述置信度低于阈值、连续丢包次数达到阈值、首径功率突降超过阈值或姿态变化超过阈值时,触发双天线轮询、交替发送、快速轮询或工作天线切换,以恢复跟随链路。

8、步骤s6:重复步骤s1至步骤s5,进行闭环实时跟随。

9、可选地,所述步骤s2中选择信号质量较高的天线对应帧的测距测角数据作为有效输出,具体通过以下方式实施:

10、步骤s11:根据天线质量评估触发条件,触发天线质量评估;

11、步骤s12:双天线轮询测量,控制器控制射频开关依次切换至第一天线和第二天线,分别收发uwb测试帧或测距帧,获取两路天线各自的链路质量参数;

12、步骤s13:根据两路天线各自的链路质量参数分别计算第一天线质量值q1和第二天线质量值q2;

13、步骤s14:根据天线质量值进行天线选择决策,输出天线id,作为天线标识。

14、可选的,所述步骤s13中天线质量值qi,通过以下方式计算:

15、qi = w1×fp_i + w2×(fp_i/rx_i) + w3×ack_i - w4×nlos_i - w5×retry_i - w6×rangeresidual_i;

16、其中,i表示天线编号,fp_i为首径功率,rx_i为总接收功率,ack_i为报文成功率,nlos_i为非视距风险值,retry_i为重传次数,rangeresidual_i为测距残差,w1至w6为加权系数。

17、可选的,所述步骤s14中天线选择决策包括滞回机制:

18、若q1和q2均高于正常阈值th_normal,选择质量值较高的天线作为工作天线;

19、若当前工作天线为第一天线,仅当q2-q1差值大于滞回阈值th_hysteresis时才切换至第二天线;若当前工作天线为第二天线,仅当q1-q2差值大于滞回阈值th_hysteresis时才切换至第一天线;

20、若q1和q2均低于告警阈值th_alarm,进入双天线交替重发模式,每帧交替使用两路天线发送;

21、恢复后若某一天线质量值连续n个周期优于另一天线,将其设为主用天线并降低轮询频率。

22、可选的,所述步骤s11中触发条件为:

23、(a)初始入网时触发;

24、(b)周期性评估定时到达时触发;

25、(c)当前工作天线连续丢包次数达到阈值时触发;

26、(d)首径功率突降超过阈值时触发;

27、(e)基站返回的aoa质量值低于阈值时触发;

28、(f)三轴传感器检测到姿态变化超过角度阈值时触发。

29、可选的,所述步骤s1中tag含有高频交替轮询模式,通过以下方式实施:

30、tag以设定频率在第一天线和第二天线之间逐帧交替切换,两根天线轮流与基站进行tof测距和pdoa测角通信,每帧uwb报文中携带当前使用的天线id;

31、基站端接收到tag双天线交替发送的报文后,根据每帧的接收信号质量进行实时评估,选择信号质量较高的天线所对应的该帧测距测角数据作为有效输出,丢弃质量较低天线的该帧数据;

32、基站根据天线id调用对应的通道时延补偿参数对测距值进行修正。

33、可选的,所述方法还包括双天线校准补偿,通过以下方式实施:

34、出厂校准:分别通过第一天线和第二天线对已知距离的基准标签进行tof测距,记录两路天线测距值与真实距离的偏差,计算两路天线之间的群时延差和相位中心偏移,将补偿值写入tag的非易失性存储器;

35、实时补偿:正常工作时,根据当前工作天线的天线id,调用对应的通道时延补偿值进行修正,天线切换发生时,测距帧自动切换至新天线对应的补偿参数。

36、可选的,所述双天线分级功耗管理,通过以下方式实施:

37、正常工作模式下,使用上一周期最优天线进行通信,每隔n个测距周期执行一次双天线质量评估,异常触发时,立即启动双天线快速轮询模式,低电量时,延长轮询间隔或仅保留异常触发条件作为评估启动条件。

38、一种用于uwb双天线tag的目标跟随控制装置,采用所述用于uwb双天线tag链路的目标跟随控制方法,其特征在于,包括印刷电路板、uwb收发控制单元、射频开关、第一板载uwb天线和第二板载uwb天线;所述射频开关的公共端连接所述uwb收发控制单元的射频端口,所述射频开关的两个选择端分别连接所述第一板载uwb天线和第二板载uwb天线;所述第一板载uwb天线和第二板载uwb天线分别设置于所述印刷电路板的不同净空区域,且二者的馈入方向、辐射主方向或等效极化方向不完全相同;所述uwb收发控制单元被配置为控制所述射频开关在两路板载uwb天线之间切换、轮询或选择,并在uwb报文或控制报文中输出当前天线id。

39、可选的,所述第一板载uwb天线和第二板载uwb天线分别包括八边形或变形八边形分形辐射单元,所述八边形或变形八边形分形辐射单元包括八边形金属辐射片,所述八边形金属辐射片的至少部分边缘设置有齿形、阶梯形、凹槽形、锯齿形或矩形支节分形扰动结构。

40、一种用于uwb双天线tag链路的目标跟随控制系统,采用所述用于uwb双天线tag链路的目标跟随控制方法,包括双天线通信与轮询模块、信号质量评估与天线决策模块、数据校准与补偿模块、运动控制与跟随模块和功耗管理模块;

41、双天线通信与轮询模块,用于控制tag的两根天线逐帧交替与基站进行通信,在每帧uwb报文中携带当前使用的天线id,以便基站识别,利用tof进行测距,利用pdoa进行测角;

42、信号质量评估与天线决策模块,用于根据双天线链路参数,通过加权算法计算天线质量值,基于质量值选择信号更好的天线作为有效输出,并引入滞回机制防止天线频繁切换,当信号质量均低于阈值时,触发双天线交替重发模式,在特定触发条件下启动评估;

43、数据校准与补偿模块,用于根据当前工作天线的id,调用对应的补偿参数修正测距值,记录两路天线与真实距离的偏差,计算群时延差和相位中心偏移,并存储于非易失性存储器中;

44、运动控制与跟随模块,用于将方位角偏差转化为转向控制量,将距离偏差转化为速度控制量,当置信度低于阈值时,控制载具维持上一状态或减速制动;

45、功耗管理模块,用于在正常模式下降低轮询频率以省电,仅在异常触发时启动快速轮询,在低电量状态下延长轮询间隔或仅保留必要的异常触发评估。

46、本发明的有益效果:

47、1、本发明通过tag端两路板载uwb天线的非同方向或非同极化分集,使至少一路天线在多种佩戴姿态下保持较高链路质量,从而降低单天线tag因极化失配、方向图空洞或人体遮挡造成的丢包风险。

48、2、本发明提供tag端智能选择模式和基站端高频交替轮询模式两类工作模式;在低速或相对静止场景下可降低轮询频率以节省功耗,在姿态快速变化的移动跟随场景下可将逐帧择优判决交由基站侧完成,从而降低tag端误判导致的跟随数据抖动。本发明通过天线id上报和按天线通道调用校准补偿参数,能够补偿两路板载天线之间的群时延、馈线时延、相位中心偏移或通道损耗差异,减少双天线切换导致的测距跳变。

49、3、本发明采用单uwb收发控制单元配合射频开关的时分复用结构实现双天线分集,有利于控制硬件成本、尺寸和功耗;具体成本、功耗、误差和续航指标可根据实际测试条件确定。本发明可与uwb aoa基站或tof测距基站配合,用于机器人、机器狗、高尔夫球车、智能轮椅、智能行李箱或无人搬运车等移动载具跟随场景。