一种基于UWB多基站定位周期的多标签指令协同控制方法

摘要: 本发明属于超宽带无线通信、室内定位、嵌入式控制及多节点协同任务执行,具体涉及一种基于uwb多基站定位周期的多标签指令协同控制方法。背景技术:1、现有uwb定位系...
一种基于UWB多基站定位周期的多标签指令协同控制方法

本发明属于超宽带无线通信、室内定位、嵌入式控制及多节点协同任务执行,具体涉及一种基于uwb多基站定位周期的多标签指令协同控制方法。

背景技术:

1、现有uwb定位系统通常由多个基站和多个标签组成,基站与标签之间通过tof、twr或tdoa等方式进行测距和定位。常见方案主要关注定位精度、基站布设、时钟同步、基站标定、硬件射频性能等方面。例如,已有uwb基站自标定方法可通过基站间两两测距构建距离矩阵,并结合多维尺度变换与锚点基站坐标关系实现基站真实坐标求解;也有方案通过优化基站电源管理、射频前端、双天线结构、低温漂时钟电路等方式提高定位基站的可靠性、传输距离或定位精度。

2、在实际应用中,若需要使标签或搭载标签的移动体执行特定任务,通常需要额外设置独立通信链路,例如蓝牙、wi-fi、串口透传模块或其他无线控制模块,用于向目标标签下发控制指令。也有部分系统仅能完成定位数据上传,不能在不影响定位周期的情况下对单个或多个标签进行可靠任务控制。因此,现有方案大多将“定位通信”和“任务控制通信”分离处理,系统结构复杂,实时性和可扩展性不足。

3、现有技术中,中国专利202110481778.9公开了一种基于图形标签的无人机任务规划方法,其方案包括:1)构建由外框、方向指示标及图标三部分元素组成的标签;2)按照任务内容选择并使用各类标签组成标签块,并将所有标签块放置在预设地点;3)对标签和标签块编号,并对特殊标签进行定义;4)将无人机摄像头对准第一个标签块方向,启动无人机;6)无人机检测并读取标签块,生成具有可循环、可中断的性质的标签序列;7)无人机根据标签序列自动运行,完成任务。

4、中国专利202511525173.x公开了一种电子标签的定位方法、系统、电子标签及电子设备,定位方法包括:电子设备与至少一个电子标签建立通信连接,在对目标电子标签进行定位时,响应于电子设备接收到的定位请求,向目标电子标签发送携带指示参数的定位指令,其中,目标电子标签为至少一个电子标签中的至少一个;目标电子标签在接收到定位指令后,控制激光模组点亮并向上发射垂直光束,使其在目标空间的顶面形成可视光斑以提供远距离方位指示,同时控制指示灯按照指示参数进行工作以提供近距离方位指示;目标电子标签在满足关断条件时,关断激光模组和指示灯。

5、中国专利201710091700.x公开了一种运送机器人定位与任务管理方法及装置,方法包括步骤:布置rfid地标,采集rfid标签信息和对应的位置信息并传输到上位机;上位机通过xbee将采集的rfid标签信息和对应的位置信息传输给运送机器人;运送机器人将接收的信息固化于控制芯片的储存空间完成初始化;运送机器人通过高频rfid读卡器读取rfid标签,并且通过xbee将位置信息发送给上位机;上位机接收运送机器人发送的位置信息,监控运送机器人的运作状态。

6、上述现有技术主要存在以下缺点:

7、1、定位链路与控制链路分离,若为任务控制额外增加无线通信模块,会导致系统硬件复杂度、电路成本、功耗和开发难度增加。

8、2、多标签场景下,若多个标签同时需要接收任务指令,容易出现指令冲突、通信拥塞或标签误执行问题,缺乏基于标签编号和定位周期的统一调度机制。

9、3、传统uwb定位过程主要关注测距和坐标输出,未充分利用定位周期中标签与基站已经建立的通信关系,导致uwb链路的控制能力没有被有效利用。

10、4、若控制指令缺少确认和清除机制,基站可能重复下发同一指令,标签可能重复执行任务;若直接在定位过程中插入控制通信,又可能破坏原有测距时序,导致定位不稳定。

11、5、对于生物机器人、移动机器人、巡检标签等需要“边定位、边控制、边执行任务”的应用场景,现有方案难以同时满足连续定位、指定标签控制、任务执行确认和多标签扩展需求。

12、因此,如何提供一种多标签定位和任务执行一体化的多标签指令协同控制方法,成为业界需要解决的问题。

技术实现思路

1、为解决现有技术中所存在的不足,本发明的主要目的是提供一种基于uwb多基站定位周期的多标签指令协同控制方法,其通过复用uwb定位通信链路,使多基站多标签uwb系统在持续完成定位测距的同时,能够利用定位周期中的特定通信窗口向目标标签下发任务指令,并通过标签确认帧实现指令执行确认和基站端指令清除。

2、为了实现上述主要目的,本发明提供了一种基于uwb多基站定位周期的多标签指令协同控制方法,其包括:

3、a、上位机生成多标签任务指令帧,多标签任务指令帧包括帧头、若干任务字段和帧尾;每个标签对应一个固定长度的任务字段;

4、b、主基站接收上位机下发的多标签任务指令帧,并将其解析为多标签指令缓存表;多标签指令缓存表存储若干任务指令;每个标签对应一组任务指令,该任务指令包含该标签对应的任务字段;

5、c、标签按照预设时隙与主基站和多个辅助基站进行双向测距,标签计算其与各个基站之间的距离,并输出定位数据;

6、d、主基站在接收到标签的final报文后,根据其中的标签编号查询多标签指令缓存表;若该标签对应的任务字段不为空,则主基站在该标签完成双向测距后的指令下发窗口中,向该标签发送其对应的任务指令报文;

7、e、标签在完成双向测距后进入指令等待状态;若标签在其指令下发窗口中接收到与自身编号匹配的任务指令报文,则解析任务字段,将任务内容写入本地任务缓存,并向主基站返回确认报文;反之,则标签退出指令等待状态,并进入下一定位周期。本发明中,任务字段中可包括led控制、执行机构控制、传感器采集触发、摄像头采集触发或其他外设任务触发信息。未被控制的标签对应任务字段置为空指令。

8、本发明中,多标签指令缓存表按照标签编号存储任务指令。

9、本发明中,主基站在收到新的多标签任务指令帧后会更新多标签指令缓存表,并在后续定位周期中按标签编号选择性下发。

10、本发明中,标签与主基站和辅助基站通过uwb进行双向测距。

11、本发明中,所有基站均参与测距定位;主基站和上位机进行联络通信,在硬件结构上与辅助基站没有本质区别。

12、本发明中,主基站通过uwb链路向标签发送任务指令报文。

13、本发明中,标签进入指令等待状态后,会在指令下发窗口打开uwb接收机,用于接收主基站发送的任务指令报文。

14、本发明中,标签返回确认报文说明标签收到了任务指令,但不代表标签一定执行了任务指令。

15、本发明中,主基站清除目标标签对应的任务指令,以避免同一任务指令重复下发导致的重复执行。

16、本发明主要解决在多基站、多标签uwb定位系统中,定位数据传输与任务控制指令下发难以协同的问题,尤其是在标签持续进行双向测距定位的同时,如何利用既有uwb通信链路向指定标签可靠下发任务指令,并实现指令确认、重复执行抑制及任务执行调度的问题。

17、本发明旨在不增加额外无线通信模块的前提下,实现定位与任务控制的一体化,使系统能够对多个标签分别下发不同任务指令,并使标签在接收指令后按照任务类型触发对应外设或执行机构。本发明可用于生物机器人控制、移动机器人调度、定位标签外设控制、巡检设备任务触发等场景。

18、根据本发明的一种具体实施方式,步骤c中,双向测距的过程为:标签发送poll报文,所有基站分别返回response报文,标签收集所有基站响应后发送final报文;标签根据poll、response、final时间戳计算其与各个基站之间的距离。

19、本方案中,标签利用消息的时间戳自行完成距离解算,解算完成后在final报文里把距离信息传回给基站。

20、根据本发明的一种具体实施方式,步骤d中,任务指令包括目标标签地址、功能码、任务字段和校验信息。

21、根据本发明的一种具体实施方式,多标签指令协同控制方法进一步包括步骤f:主基站接收到确认报文后,对其中的标签编号和任务字段进行匹配校验;若确认报文中的标签编号与当前目标标签一致,且确认报文中的任务字段与多标签指令缓存表中目标标签对应的任务字段一致,则主基站判定该任务指令已被目标标签成功接收,并清除该标签对应的任务指令。

22、根据本发明的一种具体实施方式,多标签指令协同控制方法进一步包括步骤g:标签根据本地任务缓存中的任务内容触发对应任务并执行。

23、本方案中,标签上的任务调度模块与uwb测距状态机相互独立,任务调度模块用于触发对应任务,任务执行通过嵌入式实时操作系统中的任务线程完成。对于短时任务,可直接执行并清空任务字段;对于需要占用外设或通信资源的任务,可通过任务标志位、任务队列或资源互斥机制进行调度,以避免破坏uwb测距时序。

24、根据本发明的一种具体实施方式,多标签指令协同控制方法进一步包括步骤h:当多个标签分别存在任务指令时,主基站会在收到某一个标签的final报文后,在此标签的指令下发窗口中将对应的任务指令发送至该标签。

25、本方案中,每个标签本身按照定位周期和时隙参与通信,因此指令下发也随定位周期分散进行,从而降低多标签同时控制造成的通信冲突。

26、本发明提出一种基于uwb多基站定位周期的多标签指令协同控制系统,系统包括上位机、主基站、多个辅助基站以及多个uwb标签。主基站和多个辅助基站用于与标签进行双向测距并输出定位信息,主基站同时承担指令缓存、目标标签识别、任务指令下发和确认接收功能;辅助基站主要参与定位测距响应。多个标签按照预设编号和时隙参与定位周期,并在完成测距后进入指令下发窗口。

27、本发明将uwb定位测距过程与任务指令控制过程结合起来,在不改变基本定位框架、不增加额外无线控制链路的条件下,实现多标签定位和多标签任务执行的统一调度。

28、与现有技术相比,本发明具有以下有益效果:

29、一、复用uwb定位通信链路完成任务指令下发,无需额外增加蓝牙、wi-fi或其他无线控制模块,降低了系统硬件复杂度和功耗。

30、二、将任务指令下发嵌入标签定位周期之后的指令窗口,不破坏原有poll、response、final测距流程,有利于保持定位过程连续稳定。

31、三、通过标签编号建立多标签指令缓存表,可在同一系统中对不同标签分别下发不同任务,实现多标签差异化控制。

32、四、设置标签确认报文和基站端指令清除机制,能够确认目标标签是否接收成功,并避免同一指令重复下发或重复执行。

33、五、上位机通过主基站统一调度指令下发,同时主基站和辅助基站一起参与定位响应,可兼顾多基站定位精度和单点控制管理的便利性。

34、六、适用于生物机器人、移动机器人、智能标签、巡检设备等需要边定位边执行任务的场景,尤其适合对多个小型移动体进行分布式任务控制。

35、七、软件调度结构具有扩展性,任务字段可根据应用需求扩展为led控制、运动控制、电刺激控制、传感器采集、图像采集触发等多种任务类型。

36、为了更清楚地说明本发明的目的、技术方案和优点,下面结合附图和具体实施方式对本发明作进一步的详细说明。