一种基于几何证据的机器人仿真CAD装配运动学模型自动生成方法

摘要: 本发明涉及机器人仿真建模、机器人运动学建模及数字孪生,特别是涉及一种基于几何证据的机器人仿真cad装配运动学模型自动生成方法。背景技术:1、面向机器人仿真、数字...
一种基于几何证据的机器人仿真CAD装配运动学模型自动生成方法

本发明涉及机器人仿真建模、机器人运动学建模及数字孪生,特别是涉及一种基于几何证据的机器人仿真cad装配运动学模型自动生成方法。

背景技术:

1、面向机器人仿真、数字孪生、运动规划、强化学习和具身智能系统开发的机器人资产,除需具有外观网格模型外,还必须包含连杆定义、父子关节拓扑、关节轴、关节原点、坐标系变换等运动学语义。urdf广泛用于ros机器人模型描述,mjcf是基于urdf的xml模型可用于mujoco等物理仿真环境。

2、工业机器人模型通常以step格式的cad机械装配体形式提供。step文件主要编码零件几何与装配放置信息,通常不直接提供可执行的机器人运动学信息。传统的cad到urdf导出流程往往要求用户组织连杆树、指定零件所属连杆、配置关节类型、关节轴、关节原点及坐标系,人工操作繁琐且容易出错;部分自动方法还依赖预定义模块、装配配合约束或已知dh参数;对于从工业设计文件或公开机器人cad资源中获取的step装配体而言,往往只包含几何实体和装配位置信息,而零件、连杆、关节和坐标系之间的语义对应关系并未明确给出。

3、因此,在连杆标签、关节轴线和关节原点等信息未明确提供的情况下,将工业机器人step装配体转换为可仿真的urdf/mjcf格式仍然存在较大困难。工业机器人关节附近常包含法兰、轴承座、轴壳、圆形端盖和圆柱外壳等圆形或圆柱形结构,这些几何结构能够为关节轴线和关节中心提供线索。但安装孔、盖板、装饰外壳、线缆布置结构及辅助零件中也可能具有类似圆形特征,因而单一圆形特征不能直接认定为机器人关节。因此,需要一种自动化方法进一步判断不同零件上的圆形特征是否几何兼容,以及是否能够支撑一致的父子关节假设,并生成可仿真的机器人模型。

技术实现思路

1、本发明目的是为了解决现有技术中的问题,提出了一种基于几何证据的机器人仿真cad装配运动学模型自动生成方法。

2、本发明是通过以下技术方案实现的,本发明提出一种基于几何证据的机器人仿真cad装配运动学模型自动生成方法,所述方法包括:

3、s1:step装配体解析与网格预处理;获取待处理的工业机器人step格式cad装配体文件;使用step解析工具读取装配体层次结构,遍历顶层及近顶层装配节点,识别其中的实体几何部件;

4、s2:圆形几何证据提取;针对每一个连杆级网格候选件,提取三类圆形几何证据:平面圆特征提取、边缘环特征提取和圆柱轴特征提取;

5、s3:相邻关节证据匹配与串联骨架构建;按照推断出的连杆串联顺序,依次对每一对相邻连杆执行圆形证据匹配;

6、s4:零位姿保持的仿真模型导出;基于构建好的串联运动学骨架,导出urdf和mjcf两种格式的仿真模型。

7、进一步地,输入step格式的工业机器人cad装配体,算法解析装配层级,并从顶层或近顶层结构中提取候选机械部件;根据几何尺度、包围关系和装配相关性,去除无运动学意义的实体;对于层级不完整或过度拆分的装配体,依据空间邻近性和装配关联度,将原始实体分组成紧凑的连杆级网格候选件。

8、进一步地,将各连杆级网格候选件导出为网格文件,并归一化到统一的公制尺度;计算并记录网格尺度、包围盒范围、表面分布、三角形统计量和装配邻接关系在内的基本几何与拓扑属性作为预处理元数据。

9、进一步地,针对每一连杆级网格候选件,提取平面圆、边缘环和圆柱轴三类圆形几何证据;平面圆从近似平面的表面区域中获取,其支撑点呈现圆形分布;边缘环由闭合或近闭合边界曲线、锐边环和孔轮廓获得,即使支撑曲面残缺,仍能够稳定提取圆形特征;圆柱轴特征识别自侧壁曲面区域,局部几何符合圆柱约束,能够同时提供圆形轮廓与候选轴线方向。

10、进一步地,将每一连杆级网格候选件中的缩放三角形、去重顶点、三角形法向、三角形面积和三角形中心作为特征计算基础;将候选圆特征支撑点投影至垂直于候选轴线方向的局部拟合平面,在二维投影坐标中拟合圆心与半径;对投影点,圆模型:,采用最小二乘方法来估计圆心和半径r,并以归一化径向残差评价拟合质量;对三类特征进行汇集、去重、按置信度和半径排序,并截取每个候选件的最大特征数量,形成以连杆级网格候选件为索引的圆形证据库。

11、进一步地,对有序串联零件序列中每对相邻候选件父零件和子零件,枚举父零件圆形特征库和子零件圆形特征库中的候选特征对;每项特征记录包含圆心、半径、局部轴线方向、拟合置信度和特征类型。

12、进一步地,对每个候选特征对执行多约束校检,约束包括轴线对齐度、半径一致性、中心线径向偏移、轴向匹配度、包围盒邻接性和特征置信度;将各归一化约束得分按照计算综合匹配得分;仅当全部必需几何约束条件满足且综合匹配得分超过预设阈值时,接受该候选特征对作为关节候选,而不满足条件的候选特征对直接剔除,并记录失败原因用于后续诊断。

13、进一步地,对每个相邻零件对选择得分最高的有效匹配;若无候选满足约束条件,则生成后备匹配,并明确标记为低置信度诊断证据;将第i对相邻零件的匹配结果转换为关节候选,其中、和分别为估计的关节轴线、关节原点和置信度得分;由有序零件集合与关节候选集合构成初始串联运动学骨架。

14、进一步地,依据初始串联运动学骨架导出urdf或mjcf格式的仿真模型;由估计的关节轴线和关节原点定义相邻连杆之间的可动关系;为各视觉网格设置补偿原点,使导出文件在零位姿下保持原始step装配体的外观;同步导出有序连杆和关节标识、关节特征、匹配得分、多约束校检结果、后备匹配标记的诊断记录。

15、本发明还提出一种电子设备,包括存储器和处理器,所述存储器存储有计算机程序,所述处理器执行所述计算机程序时实现所述一种基于几何证据的机器人仿真cad装配运动学模型自动生成方法的步骤。

16、本发明的有益效果:

17、本发明相比传统的cad-to-urdf转换方法,实现了从step装配体几何到仿真可用机器人模型的端到端自动生成,无需人工标注连杆标签、指定关节轴线或预设dh参数,显著降低了机器人仿真建模的人工成本和出错概率。

18、实验结果表明,本发明在多款工业机器人模型上能够稳定地在导出的连杆上恢复圆形证据,生成高置信度的父子关节匹配,所产出的urdf和mjcf格式均能通过语法解析和运动学验证测试。恢复得到的运动学骨架不仅具有几何可解释性,而且能够在仿真环境中执行连贯的铰接运动。所有导出模型均能通过单关节扫描、顺序扫描和随机采样三类运动验证测试,未观察到不稳定关节。零位姿视觉漂移均控制在可接受范围内,在保持有效运动学铰接的同时,较好地保留了原始step装配体的零位姿外观。

19、本发明为工业机器人cad模型向仿真模型的转换提供了全自动、可解释的解决方案,能够直接从step装配体几何推断串联拓扑、关节轴线和关节原点,对于机器人仿真、数字孪生、运动规划和强化学习等应用场景中的快速建模具有重要价值。

1.一种基于几何证据的机器人仿真cad装配运动学模型自动生成方法,其特征在于,所述方法包括:

2.根据权利要求1所述的方法,其特征在于,输入step格式的工业机器人cad装配体,算法解析装配层级,并从顶层或近顶层结构中提取候选机械部件;根据几何尺度、包围关系和装配相关性,去除无运动学意义的实体;对于层级不完整或过度拆分的装配体,依据空间邻近性和装配关联度,将原始实体分组成紧凑的连杆级网格候选件。

3.根据权利要求2所述的方法,其特征在于,将各连杆级网格候选件导出为网格文件,并归一化到统一的公制尺度;计算并记录网格尺度、包围盒范围、表面分布、三角形统计量和装配邻接关系在内的基本几何与拓扑属性作为预处理元数据。

4.根据权利要求3所述的方法,其特征在于,针对每一连杆级网格候选件,提取平面圆、边缘环和圆柱轴三类圆形几何证据;平面圆从近似平面的表面区域中获取,其支撑点呈现圆形分布;边缘环由闭合或近闭合边界曲线、锐边环和孔轮廓获得,即使支撑曲面残缺,仍能够稳定提取圆形特征;圆柱轴特征识别自侧壁曲面区域,局部几何符合圆柱约束,能够同时提供圆形轮廓与候选轴线方向。

5.根据权利要求4所述的方法,其特征在于,将每一连杆级网格候选件中的缩放三角形、去重顶点、三角形法向、三角形面积和三角形中心作为特征计算基础;将候选圆特征支撑点投影至垂直于候选轴线方向的局部拟合平面,在二维投影坐标中拟合圆心与半径;对投影点,圆模型:,采用最小二乘方法来估计圆心和半径r,并以归一化径向残差评价拟合质量;对三类特征进行汇集、去重、按置信度和半径排序,并截取每个候选件的最大特征数量,形成以连杆级网格候选件为索引的圆形证据库。

6.根据权利要求5所述的方法,其特征在于,对有序串联零件序列中每对相邻候选件父零件和子零件,枚举父零件圆形特征库和子零件圆形特征库中的候选特征对;每项特征记录包含圆心、半径、局部轴线方向、拟合置信度和特征类型。

7.根据权利要求6所述的方法,其特征在于,对每个候选特征对执行多约束校检,约束包括轴线对齐度、半径一致性、中心线径向偏移、轴向匹配度、包围盒邻接性和特征置信度;将各归一化约束得分按照计算综合匹配得分;仅当全部必需几何约束条件满足且综合匹配得分超过预设阈值时,接受该候选特征对作为关节候选,而不满足条件的候选特征对直接剔除,并记录失败原因用于后续诊断。

8.根据权利要求7所述的方法,其特征在于,对每个相邻零件对选择得分最高的有效匹配;若无候选满足约束条件,则生成后备匹配,并明确标记为低置信度诊断证据;将第i对相邻零件的匹配结果转换为关节候选,其中、和分别为估计的关节轴线、关节原点和置信度得分;由有序零件集合与关节候选集合构成初始串联运动学骨架。

9.根据权利要求8所述的方法,其特征在于,依据初始串联运动学骨架导出urdf或mjcf格式的仿真模型;由估计的关节轴线和关节原点定义相邻连杆之间的可动关系;为各视觉网格设置补偿原点,使导出文件在零位姿下保持原始step装配体的外观;同步导出有序连杆和关节标识、关节特征、匹配得分、多约束校检结果、后备匹配标记的诊断记录。

10.一种电子设备,包括存储器和处理器,所述存储器存储有计算机程序,其特征在于,所述处理器执行所述计算机程序时实现权利要求1-9任一项所述方法的步骤。