机器人的控制方法、装置及机器人与流程
本申请涉及机器人控制,尤其涉及一种机器人的控制方法、装置及机器人。
背景技术:
1、机器人通常搭载多种传感器,不同传感器按照各自的采样频率独立采集数据,导致多模态感知数据异步到达处理器。视觉检测结果存在较大处理延迟,关节状态数据高频实时更新,任务指令和执行反馈来自不同模块。各类数据由不同线程异步产生,时间基准和到达时刻均不一致。
2、当机器人正在执行某一任务时,若接收到更高优先级的任务,系统将进行任务切换。然而,旧任务的数据可能在新任务启动之后才到达处理器,若这些迟到的旧任务数据被继续用于控制决策,将导致机器人执行与新任务不符的动作,引发安全问题。
技术实现思路
1、本申请实施例提供了一种机器人的控制方法、机器人的控制装置及机器人,可以解决现有技术中多源数据异步到达导致的时间基准不统一以及任务切换时旧任务数据与旧命令干扰新任务执行的技术问题。所述技术方案如下:
2、第一方面,本申请实施例提供了一种机器人的控制方法,所述方法包括:
3、响应于接收到的任务执行指令,生成当前任务的活跃任务版本号;
4、接收来自不同数据源的模态数据,为每条模态数据绑定所述活跃任务版本号和添加接收时间戳,并将绑定后的模态数据封装为事件记录后写入对应模态的缓冲区;
5、读取缓冲区中的事件记录得到事件记录集合,根据模态数据的生存时间和最大乱序容忍时间,对该事件记录集合进行过期判定,得到有效事件记录集合;
6、将所述有效事件记录集合中的各个有效事件记录转换为统一坐标系和统一语义格式的标准化事件集合;
7、对所述标准化事件集合中的各个标准化事件进行跨模态关联,将指向同一目标或同一任务状态的标准化事件归入同一感知信息集合;
8、对各感知信息集合中的标准化事件进行加权融合,获得融合状态估计值、融合置信度及融合离散度;
9、根据当前任务的预设前置条件对所述融合状态估计值、所述融合置信度及所述融合离散度进行逻辑判定,若判定通过,则生成感知摘要;
10、根据所述感知摘要生成带有所述活跃任务版本号的决策帧,根据所述决策帧生成运动命令序列,并对所述运动命令序列中的每个命令进行门控校验,将校验通过的命令下发至执行器。
11、第二方面,本申请实施例提供一种计算机存储介质,所述计算机存储介质存储有多条指令,所述指令适于由处理器加载并执行上述的方法步骤。
12、第三方面,本申请实施例提供一种机器人的控制装置,可包括:处理器和存储器;其中,所述存储器存储有计算机程序,所述计算机程序适于由所述处理器加载并执行上述的方法步骤。
13、本申请一些实施例提供的技术方案带来的有益效果至少包括:
14、本申请提供的机器人控制方法,通过为当前任务生成活跃任务版本号,并将该版本号绑定至各模态数据,使得任务切换时旧任务的数据因版本号不一致而被自动淘汰,避免了过期数据对新任务执行的干扰,提升了任务切换时的安全性。
15、本申请进一步对不同模态数据设置差异化的生存时间,结合最大乱序容忍时间对事件记录进行迟到和超期双重判定,确保参与融合的数据均满足时效性要求,解决了多源数据因异步到达和传输延迟导致的时间基准不一致问题。
16、本申请在加权融合后进一步根据预设前置条件对融合状态估计值、融合置信度和融合离散度进行逻辑判定,仅在判定通过时才生成感知摘要并据此产生运动命令,避免了基于不充分或不可靠信息进行决策的风险。
17、本申请还在决策帧和运动命令中携带活跃任务版本号,并通过门控校验对每个命令进行版本号、时效性和状态一致性的多重验证,仅在全部校验通过时才将命令下发至执行器,在命令执行前形成安全防线。
18、上述机制共同作用,在数据绑定、数据筛选、决策生成和命令执行等多个环节形成了对过期数据和无效命令的隔离与防护,使机器人能够在动态环境中准确区分不同任务实例的数据,仅基于当前任务的有效信息进行决策和运动控制。
1.一种机器人的控制方法,其特征在于,包括:
2.根据权利要求1所述的方法,其特征在于,还包括:
3.根据权利要求1所述的方法,其特征在于,所述为每条模态数据绑定所述活跃任务版本号和添加接收时间戳,并将绑定后的模态数据封装为事件记录后写入对应模态的缓冲区,包括:
4.根据权利要求1所述的方法,其特征在于,所述根据模态数据的生存时间和最大乱序容忍时间,对该事件记录集合进行过期判定,得到有效事件记录集合,包括:
5.根据权利要求1所述的方法,其特征在于,所述将所述有效事件记录集合中的各个有效事件记录转换为统一坐标系和统一语义格式的标准化事件集合,包括:
6.根据权利要求1所述的方法,其特征在于,所述对所述标准化事件集合中的各个标准化事件进行跨模态关联,将指向同一目标或同一任务状态的标准化事件归入同一感知信息集合,包括:
7.根据权利要求1所述的方法,其特征在于,所述对各感知信息集合中的标准化事件进行加权融合,获得融合状态估计值、融合置信度及融合离散度,包括:
8.根据权利要求1所述的方法,其特征在于,所述根据当前任务的预设前置条件对所述融合状态估计值、所述融合置信度及所述融合离散度进行逻辑判定,若判定通过,则生成感知摘要,包括:
9.根据权利要求1所述的方法,其特征在于,所述根据所述感知摘要生成带有所述活跃任务版本号的决策帧,包括:
10.根据权利要求1所述的方法,其特征在于,所述根据所述决策帧生成运动命令序列,包括:
11.根据权利要求1所述的方法,其特征在于,所述对所述运动命令序列中的每个命令进行门控校验,将校验通过的命令下发至执行器,包括:
12.一种机器人的控制装置,其特征在于,包括:处理器和存储器;其中,所述存储器存储有计算机程序,所述计算机程序适于由所述处理器加载并执行如权利要求1至11任意一项所述的机器人的控制方法的步骤。
13.一种机器人,其特征在于,包括:如权利要求12所述的机器人的控制装置。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com