一种空间智能长时程子目标顺序约束违反检测方法与流程

摘要: 本发明涉及计算机视觉,尤其涉及一种空间智能长时程子目标顺序约束违反检测方法。背景技术:1、当前研究已在任务分解规划、子目标序列自动生成及多步骤任务逻辑校验等方面...
一种空间智能长时程子目标顺序约束违反检测方法与流程

本发明涉及计算机视觉,尤其涉及一种空间智能长时程子目标顺序约束违反检测方法。

背景技术:

1、当前研究已在任务分解规划、子目标序列自动生成及多步骤任务逻辑校验等方面取得进展,现有方法通常将长时程复杂任务分解为多个子目标,由规划算法生成子目标的执行顺序序列,供执行系统依序完成,但随着该类方法应用于子目标操作点之间存在真实空间占据、遮挡与可达性约束的实际长时程任务场景,现有方法未从三维场景空间占据状态随子目标完成而演化、以及子目标操作点在该占据状态下是否被物理遮挡的角度,将顺序依赖刻画为可通过几何碰撞检测直接计算得出的必然结果,对不同子目标对之间依赖倾向的差异缺乏基于空间几何本身的量化区分手段,缺乏仅针对具体违反顺序约束的局部子目标片段进行定向重排、同时保持其余顺序合理片段不变的处理机制,对某一处顺序违反是否会沿序列向后传导、影响其余子目标可执行性的判断,依赖静态依赖关系图的符号化传递或人工经验,缺乏独立于重排过程本身、基于场景占据状态重新逐一核算可达性的执行前逻辑验证机制,对涉及不可逆操作的硬性依赖违反与可容忍的软性偏好采用统一的处理优先级,在完成一批任务子目标规划后,缺乏将隐含顺序依赖约束系统性沉淀为可复用约束库的机制,对重复出现的同类顺序违反模式缺乏基于操作点空间类型与遮挡几何类型组合的溯源分析机制。

2、中国专利公开号:cn114820932a,公开了一种基于图神经网络和关系优化的全景三维场景理解方法,包括:步骤s1:构建数据集;步骤s2:将全景图像同时输入进训练好的二维目标检测网络和全景布局估计网络中,对二维目标检测,同时估计房间布局,再提取物体、墙体以及物体和墙体之间关系的特征;步骤s3:将提取的物体、墙体以及物体和墙体之间关系的特征嵌入到关系图卷积网络中实现对物体姿态、物体三维隐式矢量、物体与布局之间关系的估计;步骤s4:根据估计的物体姿态作为初始值进行基于碰撞检测、二维投影、关系约束的关系优化;步骤s5:使用训练好的局部隐函数从隐式矢量中解码三维几何体,实现物体重建。

3、但是,现有技术未能通过子目标间因三维空间占据遮挡造成的隐含几何依赖,精确发现顺序违反并仅对局部片段定向调整,进而导致约束违反检测准确度低。

技术实现思路

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、碰撞判定为占据栅格中存在体素与重叠则取1,否则取0;

27、计算聚合可达性;

28、若且,判定成立

29、若为新增类子目标且且,判定反向封堵关系成立

30、当成立且中,则确定顺序违反指示函数,否则为0;

31、其中,为候选进入方向,为进入行程长度,为末端执行器等效半径,为沿方向到操作点的位移量,为垂直于的横向偏移矢量,为执行后的占据栅格状态,为受反向封堵影响的子目标操作点,为受反向封堵影响的子目标。

32、进一步地,对各违反点构造调整子目标、子目标相对顺序后的假设占据栅格演化轨迹并重新计算位于子目标之后各子目标的可达性,将可达性发生翻转的子目标纳入传导影响集合;

33、风险贡献为;

34、序列综合顺序违反风险为,并按所述风险贡献由大到小排序确定违反处理优先级和违反最集中片段;

35、其中,为传导影响集合,为序列综合顺序违反风险。

36、进一步地,确定是否执行局部重排处理的过程包括:

37、将风险贡献与容忍度逐一比对,对风险贡献小于或等于容忍度的序列片段直接采纳,对风险贡献大于容忍度的子目标对确定为违反点触发分流处理,待重排片段界定为;

38、触发分流处理时,对硬性依赖的违反点执行局部重排处理;

39、对软性偏好的违反点,比较当前时间预算富余量与软性重排预计增加的耗时;

40、若则判定执行局部重排处理;

41、若则判定容忍软性偏好的违反点,不执行局部重排处理。

42、进一步地,得到更新子目标序列的过程包括:

43、仅对待重排片段内子目标构建局部依赖有向图,边为已确认的几何必然依赖;

44、对所述局部依赖有向图执行拓扑排序,得到待重排片段内满足全部已知依赖约束的更新顺序,待重排片段外子目标相对顺序保持不变;

45、按各子任务线关键路径长度计算重排后整体序列端到端时间,时间预算富余量,其中,为局部重排后的更新子目标序列,为整体序列时间预算,为时间预算富余量;

46、若,将传导影响集合向外扩展一层联合处理,即将与当前待重排片段中任一子目标在序列中直接相邻且未包含于当前待重排片段内的子目标纳入重排范围,在更大范围内重新执行拓扑排序和时间预算兼容性核查。

47、进一步地,独立执行前逻辑验证的过程包括:

48、对更新子目标序列从头重新执行占据栅格演化与可达性计算,得到验证用违反点集合v';

49、若所述验证用违反点集合v'为空集,则判定验证通过并下发执行;

50、若所述验证用违反点集合v'非空集,则判定验证不通过,退回局部重排。

51、进一步地,生成归档记录的过程包括:

52、将违反检测、更新子目标序列和验证过程归档,形成包含操作点坐标、候选进入方向、占据栅格演化片段及判定依据的记录;

53、将候选依赖对沉淀至约束库,记录内容包括为操作点类型对、遮挡几何类型、占据变化算子类型,并确定可靠度;

54、其中,c为约束,为约束c的可靠度,为历史独立验证核查次数,为确认出现过完全阻塞情形的次数。

55、与现有技术相比,本发明的有益效果在于,本发明通过引入基于三维场景占据栅格演化与操作点空间可达性计算的统一判据,将传统上依靠经验或历史统计推测的隐含顺序依赖,转变为可由几何碰撞检测和占据状态变化直接计算、验证的量化指标,依赖倾向分级依据操作点在相关子目标执行前是否存在可达替代进入方向这一几何事实来区分硬性依赖与软性偏好,从而避免了对不同依赖类型一视同仁的处理偏差,由于整个评估、检测与调度机制建立在可复现的几何计算之上,减少了对经验判断和历史统计的依赖,具备良好的可移植性和可验证性,并且能够与多种任务分解规划及子目标序列生成算法结合,仅需补充各子目标的操作点坐标与候选进入方向即可接入本方法,适用范围广泛。

56、进一步地,本发明基于占据栅格演化轨迹进行顺序约束违反检测,通过比较操作点聚合可达性在执行前后是否发生翻转来确认真实的几何必然依赖,而非依赖静态关系图的符号传递,传导影响范围通过重新计算假设顺序下占据栅格演化后的下游子目标可达性翻转情况来精确确定,从而避免了遗漏真正受违反连带影响的后续子目标,跨子任务线的交叉依赖由于共享同一全局场景占据栅格和统一可达性判据,天然被覆盖,弥补了仅关注单一子任务线内部依赖的盲区,在执行下发前,独立执行前逻辑验证从场景占据状态重新逐一核算可达性,该验证过程可在实际执行前发现并纠正遗漏,进一步提高了检测结果的可靠性。

57、进一步地,本发明在检测到顺序违反后,仅对基于占据栅格演化确认真正违反几何必然依赖的局部子目标片段触发定向重排,而非对整条序列重新完整规划,从而将重排资源精准投入必要位置,保留其余顺序合理的片段不变,避免不必要的资源浪费和规划扰动;针对不同依赖倾向的违反,本发明实施差异化的处理策略:硬性依赖违反获得更严格的处理优先级,确保几何必然依赖得到优先满足;软性偏好则结合时间预算富余量灵活判断,在预算充裕时建议重排以消除效率损失,在预算紧张时容忍该软性违反,兼顾了处理的严格性与灵活性,显著提升了长时程任务规划调整的效率和针对性。

58、进一步地,本发明通过跨任务顺序依赖约束库,实现约束的跨任务复用,可加快同类任务规划检测的效率,可靠度依据历史独立验证中是否真实构成占据阻塞动态调整,避免个别偶然样本或过时场景假设在积累初期引入不可靠约束、长期占用硬性处理资源,整个检测、重排与验证过程形成可追溯的记录,并可在三维场景视图上直观标注各违反点所处的依赖倾向,显著提升了规划过程的透明度和可追溯性。