基于数字孪生的挑毛机械臂轨迹离线编程与碰撞预验方法及系统与流程
本发明涉及机器人离线编程,具体涉及基于数字孪生的挑毛机械臂轨迹离线编程与碰撞预验方法及系统。
背景技术:
1、燕窝挑毛作业通常需要从燕盏中夹取并抽离羽毛、细毛等杂质。采用机械臂执行挑毛作业时,可以在机械臂末端安装镊取式、夹持式或针镊组合式挑毛工具,通过三维视觉装置采集燕盏表面和杂质的空间数据,并由工业计算机生成机械臂运动轨迹。
2、燕盏属于形态不规则的天然工件,不同燕盏的表面高度、局部曲率、凹陷深度和纤维走向存在差异。基于标准工件模型生成的轨迹难以准确反映当前燕盏的实际作业空间。杂质还可能仅有一部分暴露于燕盏表面,其余部分位于燕窝纤维之间。机械臂到达杂质位置后,所采用的夹取姿态和抽离方向还会影响杂质能否脱离燕盏以及抽离过程中是否会拖拽周围纤维。
3、挑毛工具的有效工作段需要进入燕盏表面邻域,并可能与当前杂质附近的燕窝区域发生作业所需的局部接触;工具杆体、连接座等非有效工作段需要避开非目标燕窝区域。将燕盏整体作为普通碰撞体时,作业所需的局部接触容易被判定为碰撞;关闭工具与燕盏之间的整体碰撞检测时,又难以发现工具进入过深、非有效工作段刮碰燕盏以及抽离运动横向拖拽燕窝纤维等风险。
4、此外,工具中心位置能够通过局部狭窄区域,并不必然表示机械臂能够完成对应运动。相邻位置之间的工具姿态可能无法连续变化,机械臂逆运动学解也可能发生构型跳变。仅依据空间位置规划得到的路径,可能在机器人运动学约束下无法连续执行。
5、三维视觉坐标转换、燕盏重复装夹、燕盏表面重建、杂质定位以及工具中心点标定均会产生误差。不同误差作用于不同数字对象,并且在不同检测方向上的影响程度存在差异。采用统一固定安全距离扩张全部对象,容易造成部分区域扩张不足或者部分可用空间被过度压缩。
6、现有离线碰撞检查通常侧重于判断既定轨迹是否发生几何干涉。轨迹未通过检查时,通常需要重新规划整条轨迹,碰撞结果难以直接定位至夹取状态、工具姿态、通道位置、进入深度或机械臂构型等具体约束层级,同时难以处理局部状态失效引起的关联路径不可达问题。
7、因此,本技术提供基于数字孪生的挑毛机械臂轨迹离线编程与碰撞预验方法及系统以解决上述技术问题。
技术实现思路
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、将连接后的完整挑毛轨迹转换为机械臂控制指令,并将机械臂控制指令与燕盏模型版本、数字孪生场景版本和轨迹阶段的预验记录组合为离线程序数据包。
48、基于同一构思,本发明还提供一种基于数字孪生的挑毛机械臂轨迹离线编程与碰撞预验系统,包括:
49、数据获取模块,配置为获取燕盏、杂质、工具和机械臂的数字孪生数据;
50、抽离状态生成模块,配置为以杂质可见方向、局部表面法向和局部纤维方向筛选候选夹取位置及抽离方向,模拟候选组合的抽离运动,保留关节连续且到达自由空间的夹取状态、安全出口状态及抽离轨迹;
51、通道构建模块,配置为在入口与夹取状态间设置通道截面,组合工具位置和姿态形成截面状态,对相邻截面状态校验插值、工具外廓和逆解约束,为约束成立组合建立过渡关系并删除约束不成立组合,并沿过渡关系从入口正向搜索、从夹取状态反向搜索,以双向可达状态及过渡关系组成关联安全出口状态的允许接触通道;
52、碰撞预验模块,配置为沿允许接触通道和抽离轨迹生成完整挑毛轨迹,沿检测方向以实测误差扩张燕盏、杂质和工具的相关边界并计算扫掠包络,按轨迹阶段、工具部位、截面状态及进入深度执行碰撞预验;
53、重构及输出模块,配置为根据碰撞预验结果处理完整挑毛轨迹,当未通过碰撞预验时,按冲突对象和越界内容修改夹取状态、允许接触通道或机械臂构型,删除失效状态及过渡关系后重做双向搜索,当通过碰撞预验时,将通过预验的轨迹转换为离线程序,当全部夹取状态失效时,生成人工处理标记。
54、与现有技术相比,其有益效果在于:
55、本发明公开了基于数字孪生的挑毛机械臂轨迹离线编程与碰撞预验方法及系统,通过获取当前燕盏、杂质、工具和机械臂的数字孪生数据,并根据杂质可见方向、局部表面法向和局部纤维方向筛选夹取位置及抽离方向,在抽离模拟中保留能够连续到达自由空间的夹取状态和安全出口状态,从而使工具进入轨迹与安全抽离条件建立关联。
56、通过在入口与夹取状态之间构建包含工具位置和姿态的截面状态,并利用相邻截面状态之间的连续插值、工具外廓和机械臂逆解约束建立过渡关系,再通过正向搜索和反向搜索保留双向可达状态,能够降低局部状态可行但整体运动链路不可执行的情况。
57、通过沿检测方向根据实测误差扩张燕盏、杂质和工具的相关边界,并结合轨迹阶段、工具部位、截面状态和进入深度执行碰撞预验,能够区分挑毛作业所需局部接触与异常碰撞,并反映不同误差来源对对应数字对象的影响。
58、根据碰撞预验结果修改夹取状态、允许接触通道或机械臂构型,并在状态或过渡关系失效后重新执行双向搜索,能够将冲突反馈至对应约束层级,同时保留未受冲突影响的有效状态和轨迹。
59、对通过预验的轨迹进行多杂质安全连接并转换为离线程序,在全部夹取状态失效时生成人工处理标记,从而提高挑毛机械臂离线轨迹生成过程的连续可执行性和异常处理能力。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com