一种支持多机器人协同的实时控制与任务调度系统及其方法与流程
本发明涉及机器人,尤其涉及一种支持多机器人协同的实时控制与任务调度系统及其方法。
背景技术:
1、在智能仓储、智能制造等领域,机器人协同作业日益普遍。例如,申请号为202010042458.9的中国专利文件,公开了一种配送机器人的移动协同控制系统及控制方法,该控制系统包括:用户终端,用于发起机器人调用指令;与配送机器人通信连接的机器人调度终端,用于可对多个与其对应的配送机器人进行配送任务调度;通过网络与用户终端和所述机器人调度终端通信连接的协同控制终端,协同控制终端接收来自用户终端的机器人调用指令并转发给所述机器人调度终端,并可从机器人调度终端处获取配送机器人的实时动态信息以及各配送机器人的避障辅助信息,协同控制终端根据配送机器人的实时动态信息和避障辅助信息控制配送机器人的移动避让。本发明可以避免配送机器人因导航系统或避让策略的不同发生碰撞等异常情况,有利于保障配送任务的顺利完成。
2、但是该专利也存在一些问题,一是缺乏集中-分散相结合的协同机制,难以兼顾全局优化与局部快速响应,导致任务冲突、路径拥堵;二是实时控制与任务调度分离,控制指令延迟高,无法满足毫秒级协同响应;三是机器人故障或新任务插入时,系统不能动态重调度或重调度代价大,影响整体效率。
技术实现思路
1、基于背景技术存在缺乏协同机制,实时控制与任务调度分离,动态重调度受限的问题,本发明提出了一种支持多机器人协同的实时控制与任务调度系统及其方法。
2、本发明提出的一种支持多机器人协同的实时控制与任务调度系统,包括:
3、全局调度层模块,部署于云端服务器或边缘服务器,全局调度层模块被配置为接收所有待执行的任务,对任务进行分解以形成多个子任务,为每个子任务分配执行机器人和作业资源,结合预设的全局环境地图进行路径预规划,生成每个机器人的调度表,调度表包含按时间顺序排列的路径段序列,每个路径段序列关联一个全局同步时间戳,用于指示该路径段动作的起始执行时刻,全局调度层模块还将调度表通过无线网络下发至对应的机器人;
4、实时控制层模块,包括分别固定设置于每个机器人的本地控制器,本地控制器设有调度解析单元和运动控制接口,调度解析单元用于接收调度表,提取路径段及关联的全局同步时间戳,并基于本地时钟与全局同步时间戳的比对,在时间戳到达时,通过运动控制接口,发出底层运动控制指令,驱动机器人执行器,本地控制器还连接有v2x通信单元和5g通信单元,按照预设广播周期,实时广播机器人自身的状态信息数据包,状态信息数据包至少包含实时位置坐标、速度矢量、负载状态和当前时间戳;
5、冲突消解模块,与本地控制器连接,冲突消解模块用于接收其他机器人广播的状态信息数据包,基于接收的位置和速度信息,进行轨迹预测,当预测到与任一其他机器人之间的距离在预设安全阈值内或发生路径资源争用时,触发基于优先级的令牌传递协议,在存在冲突风险的机器人之间进行令牌传递协商,以通过暂态速度微调或短时等待消解冲突,不向全局调度层模块请求重规划;
6、全局调度层模块还包括弹性重调度单元,用于持续监测各机器人的在线状态和任务执行情况,在检测到任意机器人发生故障失效,或接收到外部系统插入的紧急任务时,确定受影响的任务子集,受影响的任务子集包括失效机器人的未完成子任务,以及路径与未完成子任务的规划路径存在时空交叠的其他机器人的相关子任务,弹性重调度单元仅对受影响的任务子集进行任务重新分解、资源重新分配和路径重新规划,生成增量调度更新数据,并将增量调度更新数据发送至对应的机器人,未受影响的机器人按原调度表继续执行,通过全局调度层集中规划与实时控制层分布式执行结合,避免任务冲突和路径拥堵;调度表附加全局同步时间戳,实现调度与控制的紧耦合,配合5g/v2x实时广播,满足毫秒级协同响应;冲突消解采用基于优先级的令牌传递协议本地协商,无需全局重算,响应快且扩展性强;弹性重调度机制仅对受影响任务子集增量更新,系统不间断运行,显著提升整体效率和动态适应能力。
7、优选地,所述全局调度层模块生成的调度表中,全局同步时间戳基于与各机器人本地控制器同步的统一时钟源,本地控制器包含时钟同步单元,用于通过5g网络与全局调度层模块进行时钟同步,调度解析单元在检测到本地时钟到达全局同步时间戳时,准时触发对应路径段的运动控制指令,以实现多机器人之间的毫秒级协同,通过全局同步时钟与时间戳准时触发机制,确保各机器人在统一时间基准下协同动作,消除指令触发时刻的不确定性,从源头上保障多机毫秒级协同的时序精度。
8、优选地,所述弹性重调度单元确定受影响的任务子集的具体方式为:将失效机器人尚未执行的子任务,标记为失效任务,遍历其他机器人的调度表,任一机器人的规划路径,与任一失效任务的规划路径,在时间和空间维度上,同时存在重叠区间时,则将该机器人中与重叠区间对应的子任务,纳入受影响的任务子集,全局调度层模块部署于设置在作业场地边缘的服务器中,服务器通过5g独立组网与各机器人的5g通信单元实现通信,以满足毫秒级协同响应的延迟要求,明确弹性重调度中受影响子集的确定规则,仅将路径存在时空交叠的任务纳入重规划范围,避免对无关任务的不必要调整,使增量更新更精准、高效。
9、优选地,所述预设广播周期为10毫秒,状态信息数据包中包含与全局调度层模块同步的时间戳,以使其他机器人在进行轨迹预测时进行时间对齐,将广播周期设定为10毫秒并在数据包中携带同步时间戳,使各机器人能以足够频率获取邻居最新状态并消除时间偏差,提升冲突预测的准确性和时效性。
10、优选地,每个机器人还配置有传感组件,传感组件至少包括惯性测量单元和编码器,惯性测量单元用于获取机器人的加速度和角速度,编码器用于获取轮速,本地控制器利用传感器融合算法根据加速度、角速度和轮速解算得到机器人的位置和速度,引入惯性测量单元和编码器并通过融合解算获取位置速度,在不依赖外部定位设施的条件下实现高频、稳健的自身状态估计,为实时广播与冲突预测提供可靠数据源。
11、优选地,所述冲突消解模块执行基于优先级的令牌传递协议为:向每台机器人分配一个协商优先级,协商优先级根据机器人的任务紧急程度、剩余电量或当前负载状态中的至少一个参数动态确定,当检测到机器人间存在潜在冲突时,由其中协商优先级最高的机器人产生令牌消息,令牌消息按照优先级由高到低的顺序,在冲突机器人之间传递,持有令牌的机器人根据协议规则决定是否执行速度微调或短暂等待,并将协调动作指令随令牌传递,直至冲突消解,通过任务紧急程度、电量或负载动态确定协商优先级,使令牌传递协议能够适应环境和任务变化,优先保障关键任务,提升冲突消解的合理性与整体作业效率。
12、优选地,所述冲突消解模块进行轨迹预测时,采用基于当前速度和方向的匀速运动模型,推算未来预设时段内各机器人的轨迹点序列,计算轨迹点序列之间的最小预测距离;当最小预测距离小于预设安全阈值时,判定存在碰撞风险并触发令牌传递协议,采用匀速运动模型推算未来轨迹点序列并以最小预测距离判断碰撞风险,计算简洁、实时性好,可在本地控制器有限算力下快速、可靠地触发令牌传递协议。
13、优选地,所述全局调度层模块通过以下方式监测机器人失效:连续缺失超过预设数量的广播周期状态信息数据包时,或者从接收到的状态信息数据包中解析出预设的故障标识字段时,则判定该机器人失效并立即触发弹性重调度单元,以连续缺失状态包或解析故障标识作为失效判定依据,能快速、明确地检测机器人故障,及时触发弹性重调度,防止单点失效扩散影响全局作业。
14、优选地,所述匀速运动模型轨迹预测:对于任意预测时刻(,)
15、,
16、展开为坐标形式:和,
17、机器人间距预测:,
18、最小预测距离与碰撞风险判定:,
19、碰撞风险判定条件;
20、:机器人在当前时刻的位置坐标(m);:机器人在当前时刻的速度矢量(m/s);
21、:预测时间窗口(s,通常取0.5~2s);:预测步长(s,通常取0.1s);:预设安全距离阈值(m)。
22、一种支持多机器人协同的实时控制与任务调度方法,包括以下步骤:
23、s1:全局调度层接收待执行的任务,进行任务分解以得到子任务集,为各子任务分配执行机器人及作业资源,并结合全局环境地图进行路径预规划,生成各机器人带有全局同步时间戳的调度表,调度表包含按时间排列的路径段和每个路径段的起始时间戳,将调度表通过网络下发给对应机器人的本地控制器;
24、s2:机器人的本地控制器,接收并解析调度表,基于本地时钟与全局同步时间戳的比对,在时间戳到达时,输出底层运动控制指令,驱动机器人沿期望路径运动,同时,按照固定广播周期,通过v2x或5g无线通信,实时广播自身状态信息,状态信息包括实时位置、实时速度、负载状态和时间戳;
25、s3:机器人接收其他机器人广播的状态信息,基于接收到的位置和速度进行轨迹预测,当判定存在碰撞风险或路径资源冲突时,触发基于优先级的令牌传递协议进行本地协商,由优先级最高的冲突机器人,发起令牌消息,令牌在冲突方之间传递,持有令牌的机器人根据协商规则,执行速度微调或短暂等待,直至冲突消解;
26、s4:全局调度层持续监听各机器人的运行状态,当判定有机器人失效,或接收到新增紧急任务时,确定受影响的任务子集,受影响的任务子集包括失效机器人未完成的子任务,以及与未完成子任务存在时空交叠的其他机器人的相关子任务,仅对受影响的任务子集进行重新规划,生成增量调度更新数据,并下发给对应的机器人,未受影响的机器人继续执行原调度表。
27、本发明的有益效果:
28、1、采用全局调度层集中进行任务分解、资源分配和路径预规划,保证全局优化,结合实时控制层的分布式本地执行与状态广播,实现集中-分散有机结合的协同机制,有效避免任务冲突和路径拥堵,克服了纯集中式单点瓶颈与纯分布式局部死锁问题;
29、2、通过在调度表中附加全局同步时间戳,由本地控制器严格按时间戳触发运动控制指令,实现任务调度与实时控制的紧耦合,消除了传统架构中的解析与指令延迟;配合5g/v2x实时状态广播,多机器人基于统一时间基准进行协同,响应延迟达毫秒级,满足高动态协同的实时性要求;
30、3、冲突消解采用基于优先级的令牌传递协议进行本地协商,无需返回全局重算,大幅降低通信与计算开销,确保冲突快速消解;且协议仅涉及冲突相关方,系统扩展性强,适用于大规模机器人密集作业;
31、4、弹性重调度机制在机器人失效或紧急任务插入时,仅对受影响的任务子集进行增量规划更新,其余机器人不间断运行,实现了动态平滑调整,显著提升系统整体作业效率、鲁棒性和动态环境适应能力;
32、通过全局调度层集中规划与实时控制层分布式执行结合,避免任务冲突和路径拥堵;调度表附加全局同步时间戳,实现调度与控制的紧耦合,配合5g/v2x实时广播,满足毫秒级协同响应;冲突消解采用基于优先级的令牌传递协议本地协商,无需全局重算,响应快且扩展性强;弹性重调度机制仅对受影响任务子集增量更新,系统不间断运行,显著提升整体效率和动态适应能力。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com