一种面向机器人运动控制优化问题的快速分层求解方法与流程
本发明涉及机器人运动控制,具体涉及一种面向机器人运动控制优化问题的快速分层求解方法。
背景技术:
1、随着机器人向复杂多任务并发执行方向发展,面向多接触关系的机器人运动控制通常需要在一个固定伺服控制周期内,将多源异构输入冻结为同一时间基准下的只读快照。常规控制架构将其转化为分层凸二次规划问题进行求解。正常状态下,求解器遵循严格的优先级法则,低优先级任务被限制在利用零空间基构建的且不改变高优先级前置固定层最优解的剩余自由度中进行搜索与优化,进而生成控制指令。
2、当机器人遭遇接触状态瞬态突变导致局部约束条件发生改变时,常规求解方案面临控制状态污染与计算超时的问题:若直接复用旧求解状态进行热启动,已失效的陈旧边界会被继续视为活动约束,沿层级向下传播并污染完整决策向量,将违背实际工况的陈旧指令下发至执行端极易引发设备失控;若执行全层冷启动策略,清空变量初值并从第一层开始全局重算,会导致未受局部变化影响的高优先级前置任务被反复求解。在受限的求解放行截止时长内,无效算力消耗会耗尽后续任务的时间预算,引发求解超时异常。因此,亟需解决的技术问题在于:在约束条件突变且控制时限固定的环境下,如何兼顾计算的实时性与状态的准确性,在避免全局无效重算的同时,彻底阻断陈旧越界状态向底层关节伺服传递。
技术实现思路
1、针对现有技术的不足,本发明提出一种面向机器人运动控制优化问题的快速分层求解方法,解决其在局部约束条件突变时,全局重算易导致计算超时,而复用陈旧状态易引发设备失控的问题。
2、为实现以上目的,本发明通过以下技术方案予以实现:
3、将多源异构输入冻结为当前周期只读快照,结合单调时钟时刻计算求解放行截止时长;
4、比对当前周期只读快照与前一周期层级证书副本,基于动态生成的各项容限逐层评估证书有效位,确定最早失效层;
5、当最早失效层大于第一层且不大于任务层级总数时,提取前一周期层级证书副本中最早失效层的上一层记载的原始解作为固定前缀解,依据当前周期只读快照内的活动实体构建活动约束矩阵以生成零空间基,并基于最早失效层、固定前缀解与零空间基,对最早失效层及其后续任务层级逐层求解缩减二次规划问题,分别得到缩减决策向量并恢复完整决策向量,验证前置固定层当前计算的目标函数值或松弛变量未超过前一周期层级证书副本中记录的对应目标函数值或松弛变量与对应允许带之和,在当前执行时刻早于或等于求解放行截止时长时生成候选全层解;
6、根据候选全层解中的完整决策向量、与候选全层解对应的对偶量以及当前周期只读快照中的各项约束矩阵与边界向量,重新计算残差,依据残差与当前执行时刻评估指令写入或放行谓词,当判定结果为一时,结合从设备能力表读取的指令线性映射矩阵生成控制指令并写入伺服缓冲。
7、进一步地,将多源异构输入冻结为当前周期只读快照,包括:
8、在预分配的包含活动缓冲与非活动缓冲的双缓冲问题快照区中选中非活动缓冲,将非活动缓冲置为数据收集状态;
9、提取多源异构输入内控制实体的实体标识符进行查重,结合控制纪元进行校验,并为各个控制实体生成包含物理坐标系属性与离散化接触状态的语义与版本向量;
10、在求解放行截止时长晚于系统执行至合规性核验操作时的实时时间戳时,提取非活动缓冲内的全量数据特征位计算生成活动快照版本标识,原子地将非活动缓冲的状态从数据收集状态切换为封存状态,使快照转为当前周期只读快照。
11、进一步地,结合单调时钟时刻计算求解放行截止时长,包括:
12、将单调时钟读取的当前周期的开始时刻与伺服控制周期相加,并剔除总线最坏传输时长、驱动最坏接收时长以及安全保护余量时长,得到求解放行截止时长。
13、进一步地,动态生成的各项容限包括原始可行残差判定容限、对偶驻点残差判定容限、互补残差判定容限以及秩判定容限,基于动态生成的各项容限逐层评估证书有效位前,包括:
14、提取当前层各项约束矩阵的行范数并与底层求解器上报的浮点机器精度相乘,生成原始可行残差判定容限;
15、融合底层设备当前的编码器位移分辨率界限与预留的约束安全裕度,合成对偶驻点残差判定容限与互补残差判定容限;
16、监测当前活动约束矩阵的条件数并结合奇异值截断阈值,推导出秩判定容限。
17、进一步地,基于动态生成的各项容限逐层评估证书有效位,包括:
18、针对当前评估的任务层级,核验以下条件一至条件六:
19、条件一,当前周期只读快照与前一周期层级证书副本中对应实体的语义与版本向量保持一致;
20、条件二,重新计算的原始可行残差不大于原始可行残差判定容限;
21、条件三,重新计算的对偶驻点残差不大于对偶驻点残差判定容限;
22、条件四,重新计算的互补残差不大于互补残差判定容限;
23、条件五,前一周期层级证书副本中保存的当前任务层级的不等式对偶乘子向量中的所有元素均大于或等于零;
24、条件六,依据秩判定容限重新计算得到的当前活动约束矩阵秩与前一周期层级证书副本中记录的秩相等;
25、当条件一至条件六均满足时,将当前任务层级的证书有效位判定为通过;
26、当条件一至条件六中的至少一项不满足时,将当前任务层级的证书有效位判定为失效。
27、进一步地,依据当前周期只读快照内活动实体构建活动约束矩阵以生成零空间基,包括:
28、检查前一周期层级证书副本中零空间基的生成版本与当前活动版本是否一致,并同步评估矩阵正交误差;
29、若生成版本与当前活动版本一致且矩阵正交误差未超过预设的正交舍入误差阈值,直接复用前一周期层级证书副本中的零空间基;
30、若生成版本与当前活动版本不一致或矩阵正交误差超出正交舍入误差阈值,调用正交三角分解算法或奇异值分解算法对当前活动约束矩阵重新计算,生成列正交的零空间基。
31、进一步地,基于最早失效层、固定前缀解与零空间基求解缩减二次规划问题得到缩减决策向量,恢复完整决策向量,验证前置固定层当前计算的目标函数值或松弛变量未超过前一周期层级证书副本中记录的对应目标或松弛值与允许带之和,包括:
32、针对最早失效层及其后续各任务层级,依照任务层级顺序提取当前周期只读快照中记录的对应目标函数,执行固定前缀零空间参数化操作,将相应固定前缀解加上相应零空间基与缩减决策向量的乘积,以构造当前任务层级的缩减二次规划问题,在求解当前任务层级的缩减二次规划问题得到缩减决策向量后恢复完整决策向量,并验证前置固定层当前计算的目标函数值或松弛变量未超过前一周期层级证书副本中记录的对应目标函数值或松弛变量与对应允许带之和;
33、针对各前置固定层的目标函数值及各松弛变量分别设置对应的允许带,每一允许带采用与被比较量相同的物理单位或归一化尺度,并由系统当前周期从上层控制器下发的物理指令控制误差预算按照该被比较量的代数定义换算后所得数值的绝对值,与该被比较量的历史求解值序列的标准差相加构成。
34、进一步地,在向下启动后续任务层级的求解计算前,从单调时钟读取当前执行时刻;
35、若当前执行时刻晚于求解放行截止时长或遭遇异常情况,禁止生成求解完成标志,并评估当前剩余时间预算;
36、若当前剩余时间预算大于离线标定的全层冷启动最坏耗时预算,将最早失效层强制置为第一层,执行一次重试操作;
37、若当前剩余时间预算不足,中止当前周期求解任务,维持上一安全指令或触发独立安全控制器转交机制。
38、进一步地,依据残差与当前执行时刻评估指令写入或放行谓词,当判定结果为一时结合指令线性映射矩阵生成控制指令写入伺服缓冲,包括:
39、当满足以下安全评估条件时,将指令写入或放行谓词判定结果置为一,否则置为零:
40、候选解版本标识与当前周期只读快照版本标识一致,全层所有任务层级的各项残差均不大于对应的判定容限,且当前执行时刻早于或等于求解放行截止时长。
41、进一步地,当指令写入或放行谓词判定结果置为零时,禁止将控制指令写入伺服缓冲,包括:
42、检查上一安全指令是否处于独立看门狗允许的设备确认安全有效期内;
43、若处于设备确认安全有效期内,提交指令保持原因码,并维持上一安全指令;
44、若超出设备确认安全有效期,撤销正常写权限,向独立安全控制器发送携带当前状态与失败原因的接管请求,触发独立安全控制器转交机制执行设备预定义的安全动作。
45、与现有技术相比具备以下有益效果:
46、本方案提出的一种面向机器人运动控制优化问题的快速分层求解方法,通过基于动态容限逐层评估证书有效位,定位局部约束条件突变引发的最早失效层,提取未受影响的高优先级原始解作为固定前缀,并在其产生的零空间内针对失效后缀执行缩减二次规划求解。该机制打破了全局冷启动重算容易超时与热启动直接复用陈旧状态易导致失控的固有技术局限,避免了高层任务的冗余计算,压减了短伺服周期内的算力消耗,从算法底层截断了陈旧失效状态向执行端的传递。
47、本方案将候选全层解的残差计算、前置固定层核验与求解放行截止时长的时序约束进行严格绑定。在控制指令写入伺服缓冲前实施拦截,仅在各项残差未超过判定容限且当前执行时刻未超时的条件下放行指令。上述验证体系确保了输出控制量的精确性与时效性,结合异常超时情况下的指令保持与安全转交机制,保障了机器人在复杂交互环境下的实时控制稳定性与设备运转安全。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com