一种基于动态能力图和端云协同规划的具身智能机器人闭环控制方法及系统与流程
本发明涉及具身智能机器人端云协同控制领域,具体涉及一种基于动态能力图和端云协同规划的具身智能机器人闭环控制方法及系统。
背景技术:
1、现有的具身智能机器人端云协同控制方案多由云端完成任务理解与动作序列生成后下发至机器人本地执行,通常采用机器人出厂型号配置信息或者周期性心跳上报的能力评分表征机器人设备能力,该类方式仅能够静态描述机器人硬件配置情况,难以刻画部件温度、负载、故障、通信质量、数据新鲜度等随时间动态变化的运行状态,也无法表达各项能力之间的依赖、互斥、替代以及资源竞争约束关系,同时缺少计划与能力状态之间可核对的版本关联;受网络传输时延、状态上报间隔、多任务资源竞争的影响,云端规划所依据的能力状态经常与机器人本地实时状态发生偏离,过期、越界的计划存在向下穿透至设备控制层的风险,若机器人仅校验消息格式则无法拦截该类无效计划,若直接拒绝全部状态不匹配的计划又会在网络波动、云端响应异常时造成不必要的任务中断,并且现有系统的执行耗时、资源消耗、故障信息分散存储于日志或底层保护模块,缺少统一的数据对象回写至规划所用的能力模型,云端持续基于失真的能力状态开展任务规划,无法构建起从状态感知、计划生成、执行前校验、本地执行到反馈迭代更新的完整闭环。
技术实现思路
1、为解决机器人异构软硬件动态状态难以统一建模、云端计划与本地实时能力状态不一致,以及云端异常时边端无法在限定安全授权下开展局部自主调整的问题,本发明提供一种基于动态能力图和端云协同规划的具身智能机器人闭环控制方法,包括:
2、s1,状态采集:从交互部件、机械执行部件、电气与计算部件及软件服务获取原始状态包;原始状态包至少包括:源标识、属性标识、采样时刻、序列号、测量值、单位和质量标记;
3、s2,状态校验与归一:对原始状态包进行时钟偏差修正、序列去重、单位换算、异常值处理和新鲜度判断,将不同量纲的状态值映射为0至1区间的归一化状态分量,并形成健康度、资源余量和数据可信度;超过有效时间的数据降低数据可信度或被标记为未知;
4、s3,生成版本化动态能力图:依据部件-能力映射关系,将一个或多个归一化状态分量聚合为能力节点,并建立能力节点之间的依赖边、互斥边、替代边和资源竞争边;能力节点至少记录:节点标识、能力类型、健康度、资源余量、数据可信度、可用度、容量上限、占用量、有效时间和安全等级;每次图更新生成新的图版本,并保存相对于前一版本的增量记录;增量记录至少包括:基础版本、目标版本、更新时间、变化节点集合、变化边集合和内容摘要;
5、s4,生成云端计划契约:云端规划器基于动态能力图的全量快照或连续增量,在对应图版本的能力集合和边约束下生成任务有向无环图,并将其封装为计划契约;计划契约至少包括契约标识、任务目标、步骤集合、步骤间约束、各步骤所需能力及最低需求、有效期、允许替代集合、允许移动步骤集合、禁止变更项、回退动作和反馈字段约定,以及计划所依据的图版本引用;
6、s5,执行前边端准入:机器人边端接收计划契约后,验证契约完整性、来源认证信息和有效期,再将契约所引用的图版本与本地最新图版本进行比较;若两版本不同,则检查从契约版本至本地版本的增量链是否完整,并判断变化节点或变化边是否与计划所需能力集合相交;随后基于本地最新能力图计算各项所需能力的满足度和计划准入分,并核验全部硬安全约束;只有在契约有效、版本一致性满足、计划准入分达到阈值且硬安全约束全部满足时,才进入直接执行分支;
7、s6,受约束替代与重规划:当计划未通过直接准入但不存在不可绕过的硬安全违规时,边端重规划模块在受限搜索空间内生成候选局部计划;受限搜索空间仅由计划契约允许的替代能力、允许移动的步骤、回退动作以及本地动态能力图中满足触发条件的替代边构成;边端依次执行候选生成、硬约束剪枝、资源冲突检查、计划准入分计算和候选排序,并受最大搜索深度、最大候选数或最大计算时长中的至少一项限制;候选局部计划须再次执行s5的准入校验;不存在合格候选时执行回退动作并请求云端重新规划;
8、s7,本地执行:对通过准入的计划或候选局部计划,按照步骤先后关系和同步屏障锁定所需能力配额,将抽象能力类型映射为本机部件或软件服务命令,并为每个命令附加契约标识、步骤标识、执行所依据的能力图版本和截止时间;执行过程中持续监测硬安全事件;发生硬安全事件时停止相关动作并进入故障安全状态,不等待云端确认;步骤完成、取消或失败后释放对应能力配额;
9、s8,反馈封装:按计划步骤生成统一反馈记录,反馈记录至少包括:契约标识、步骤标识、开始时刻、结束时刻、实际调用的能力节点、实际资源消耗、完成状态、偏差类型、故障码、替代路径和配额释放结果;同一反馈记录分别发送给能力图管理模块和云端规划器;
10、s9,图更新和再次规划:依据反馈记录分别更新能力节点的健康度、资源余量、数据可信度、占用量和受影响边的可用状态,生成新的图版本;若变化仅影响当前计划的局部步骤且仍存在授权替代,则触发s6;若任务目标不可达、替代边失效、增量链不完整或出现硬安全事件,则向云端发送本地最新图版本或全量快照并请求重新生成计划契约,由此形成状态采集、能力图生成、计划契约、边端准入、受约束替代、本地执行、反馈更新和再次规划的闭环。
11、进一步,s2中,将不同量纲的状态值映射为0至1区间的归一化状态分量具体为:
12、对于取值越大性能越优的属性,将状态值映射:
13、
14、对于取值越小性能越优的属性,将状态值映射:
15、
16、其中,为第k项属性在时刻t归一化状态分量;cli为截断函数,将计算结果限制在区间[0,1],为时刻t的第k项测量值,、分别为该属性标定的有效下界、有效上界;当上下界相等时,将该属性标记为未知状态。
17、进一步,s3中,增量记录还包括前一版本摘要和目标版本摘要,机器人边端仅在版本号连续且摘要校验通过时拼接增量;若缺少中间增量、摘要不一致或本地时钟不可信,则不依据不完整增量判断计划可执行性,而是请求全量快照。
18、进一步,s3中,能力节点的可用度通过如下公式得到:
19、基础能力节点即时观测值:
20、
21、复合能力节点采用短板聚合:
22、
23、经指数平滑得到准入校验使用的节点可用度:
24、
25、其中:为基础能力节点i在时刻t的即时观测值;、、为非负权重系数;为能力节点i时刻t的健康度;为能力节点i时刻t的资源余量;为能力节点i时刻t的数据可信度;为复合能力节点i即时观测值;为复合能力节点i所依赖的全部底层能力节点集合;为依赖能力节点j的归一化可用值;为能力节点i时刻t经过平滑后用于准入校验的节点可用度;为能力节点i上一时刻平滑后可用度;为指数平滑系数;若检测到硬安全事件,则跳过指数平滑计算,直接将对应能力节点安全状态置为不满足。
26、进一步,s5中,计算各项所需能力的满足度和计划准入分具体公式:
27、能力i对于计划p的能力满足度:
28、
29、计划准入分:
30、
31、其中:为计划p下能力i的能力满足度;为大于0的极小无量纲常数,用于避免除零;为计划p对能力i的归一化需求值;为计划p的计划准入分;为计划p的关键能力节点集合;min为取最小值函数;
32、直接执行许可判定需要同时满足:
33、
34、其中,为预设准入分阈值,为当前时刻与契约生成时刻之差,为契约有效时间,为版本一致性标记,为硬安全约束满足标记,硬安全约束不满足时,不依靠准入分进行补偿。
35、进一步,s9中,依据反馈记录分别更新能力节点的健康度具体公式:
36、
37、其中,为能力节点i当前时刻健康度;为更新后下一时刻能力节点i健康度;为健康度更新步长;为由步骤执行结果映射得到的执行评价值;资源消耗优先更新资源余量,传感数据过期优先更新数据可信度。
38、还提供一种基于动态能力图和端云协同规划的具身智能机器人闭环控制系统,包括:
39、状态采集模块:用于从交互部件、机械执行部件、电气与计算部件及软件服务获取原始状态包;原始状态包至少包括:源标识、属性标识、采样时刻、序列号、测量值、单位和质量标记;
40、状态处理模块:用于对原始状态包进行时钟偏差修正、序列去重、单位换算、异常值处理和新鲜度判断,将不同量纲的状态值映射为0至1区间的归一化状态分量,并形成健康度、资源余量和数据可信度;超过有效时间的数据降低数据可信度或被标记为未知;
41、版本化动态能力图构建模块:用于依据部件-能力映射关系,将一个或多个归一化状态分量聚合为能力节点,并建立能力节点之间的依赖边、互斥边、替代边和资源竞争边;能力节点至少记录:节点标识、能力类型、健康度、资源余量、数据可信度、可用度、容量上限、占用量、有效时间和安全等级;每次图更新生成新的图版本,并保存相对于前一版本的增量记录;增量记录至少包括:基础版本、目标版本、更新时间、变化节点集合、变化边集合和内容摘要;
42、云端计划契约生成模块:用于云端规划器基于动态能力图的全量快照或连续增量,在对应图版本的能力集合和边约束下生成任务有向无环图,并将其封装为计划契约;计划契约至少包括契约标识、任务目标、步骤集合、步骤间约束、各步骤所需能力及最低需求、有效期、允许替代集合、允许移动步骤集合、禁止变更项、回退动作和反馈字段约定,以及计划所依据的图版本引用;
43、边端准入模块:用于机器人边端接收计划契约后,验证契约完整性、来源认证信息和有效期,再将契约所引用的图版本与本地最新图版本进行比较;若两版本不同,则检查从契约版本至本地版本的增量链是否完整,并判断变化节点或变化边是否与计划所需能力集合相交;随后基于本地最新能力图计算各项所需能力的满足度和计划准入分,并核验全部硬安全约束;只有在契约有效、版本一致性满足、计划准入分达到阈值且硬安全约束全部满足时,才进入直接执行分支;
44、边端重规划模块:用于当计划未通过直接准入但不存在不可绕过的硬安全违规时,边端重规划模块在受限搜索空间内生成候选局部计划;受限搜索空间仅由计划契约允许的替代能力、允许移动的步骤、回退动作以及本地动态能力图中满足触发条件的替代边构成;边端依次执行候选生成、硬约束剪枝、资源冲突检查、计划准入分计算和候选排序,并受最大搜索深度、最大候选数或最大计算时长中的至少一项限制;候选局部计划须再次执行准入校验;不存在合格候选时执行回退动作并请求云端重新规划;
45、本地执行模块:用于对通过准入的计划或候选局部计划,按照步骤先后关系和同步屏障锁定所需能力配额,将抽象能力类型映射为本机部件或软件服务命令,并为每个命令附加契约标识、步骤标识、执行所依据的能力图版本和截止时间;执行过程中持续监测硬安全事件;发生硬安全事件时停止相关动作并进入故障安全状态,不等待云端确认;步骤完成、取消或失败后释放对应能力配额;
46、反馈更新模块:用于按计划步骤生成统一反馈记录,反馈记录至少包括:契约标识、步骤标识、开始时刻、结束时刻、实际调用的能力节点、实际资源消耗、完成状态、偏差类型、故障码、替代路径和配额释放结果;同一反馈记录分别发送给能力图管理模块和云端规划器;
47、能力图管理模块:用于依据反馈记录分别更新能力节点的健康度、资源余量、数据可信度、占用量和受影响边的可用状态,生成新的图版本;若变化仅影响当前计划的局部步骤且仍存在授权替代,则触发边端受约束替代重规划模块;若任务目标不可达、替代边失效、增量链不完整或出现硬安全事件,则向云端发送本地最新图版本或全量快照并请求重新生成计划契约,由此形成状态采集、能力图生成、计划契约、边端准入、受约束替代、本地执行、反馈更新和再次规划的闭环。
48、本发明的有益效果:
49、本方案将机器人软硬件运行状态抽象为带约束关系的版本化动态能力图,云端基于能力图生成计划契约,边端依据本地实际状态做准入校验与受约束替代。一方面,通过能力节点及节点间依赖、互斥、替代、资源竞争关系,不再依赖固定硬件地址编写任务计划,可适配不同型号机器人执行同类任务;另一方面,借助计划契约携带的图版本引用、授权边界、硬安全约束,在计划下发至设备控制层前识别能力退化、资源冲突等问题,降低过期计划驱动机器人动作的风险。在云端通信短时异常的场景下,边端仅在契约授权范围内做局部计划调整,不放宽任务目标与安全限制,保障一定的任务连续性。另外,执行结果通过统一反馈记录同时回写动态能力图与云端规划上下文,让后续规划能够贴合机器人实际运行情况,实现可回溯的端云协同闭环控制。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com