一种基于冗余构型图优化的焊接机器人约束轨迹规划方法及其系统

摘要: 本发明属于工业机器人、智能制造及机器人运动规划,具体涉及一种基于冗余构型图优化的焊接机器人约束轨迹规划方法及其系统。背景技术:1、在工业焊接任务中,机器人不仅需...
一种基于冗余构型图优化的焊接机器人约束轨迹规划方法及其系统

本发明属于工业机器人、智能制造及机器人运动规划,具体涉及一种基于冗余构型图优化的焊接机器人约束轨迹规划方法及其系统。

背景技术:

1、在工业焊接任务中,机器人不仅需要使焊枪工具中心点沿预定焊缝移动,还需要保持前倾角、侧倾角、滚转角和表面法向等工艺姿态,同时避免机械臂、自身工具、外部轴、工件及工作站环境之间的碰撞。对于带有外部移动轴的多自由度工作站,同一焊接位姿通常对应多组逆运动学解,如何从中选择连续、无碰撞且便于从当前状态进入的构型序列,是影响路径规划成功率的重要因素。

2、现有技术中常见的处理方式,是先针对焊缝离散点逐点求取单一逆解或少量逆解,再对所得焊接关节序列进行平滑和碰撞检查;当前状态到焊缝起点的接近轨迹则在焊缝轨迹确定之后单独规划。该串行处理方式存在以下问题:

3、第一,焊缝起点可能存在多个满足工艺姿态的机器人构型,但先选出的构型不一定能够从当前机器人状态安全接近;当后续接近规划失败时,需要更换起点构型并重新计算部分或全部焊缝轨迹。

4、第二,逐点滚动求解容易过早固定肘部、腕部或外部轴构型,后续焊点即使存在可行逆解,也可能因构型分支丢失、关节突变或碰撞而失败。

5、第三,机械臂与外部轴经常被分开处理,外部轴只作为事后补偿量,没有统一参与逆解候选生成、相邻候选连接、路径代价和局部避障。

6、第四,在候选数量增加后,如果对所有候选间连接执行完整碰撞检查,计算量随候选层数和每层候选数快速增长,难以兼顾规划成功率和计算效率。

7、第五,普通自由空间采样规划能够绕开障碍物,但直接用于焊接段会使工具中心点偏离指定焊缝,破坏焊接工艺约束。

8、第六,仅验证离散焊点,可能遗漏相邻关节状态插值过程中的碰撞或工具中心点偏离焊缝的情况。

9、因此,需要一种能够在焊缝候选构型选择阶段提前考虑接近可达性,并在多层冗余逆解候选之间联合优化机械臂与外部轴运动的轨迹规划系统,使机器人能够从当前状态可靠进入焊缝、沿焊缝连续运动,并输出经过完整碰撞与工艺约束验证的可执行轨迹。

技术实现思路

1、本发明提供一种基于冗余构型图优化的焊接机器人约束轨迹规划方法及其系统,用于解决现有焊接轨迹规划中焊缝轨迹与接近轨迹相互割裂、单一逆解分支易失败、外部轴利用不足、候选图碰撞检查开销大以及焊接段自由空间绕行破坏焊缝约束等问题。

2、本发明通过以下技术方案实现:

3、一种基于冗余构型图优化的焊接机器人约束轨迹规划方法,所述方法包括以下步骤:

4、机器人状态建模的步骤:建立统一的多自由度机器人状态模型;

5、候选生成与预处理的步骤包括,

6、焊接位姿序列生成的子步骤:生成焊接位姿序列及姿态候选;

7、分层逆运动学求解的子步骤:分层生成冗余逆运动学候选;

8、接近可行性筛选的子步骤:将接近可行性融合到第一焊点候选筛选;

9、冗余构型图构建与全局规划的步骤包括:

10、冗余逆解候选图构建的子步骤:构建冗余逆解候选图;

11、碰撞感知动态规划的子步骤:通过碰撞感知动态规划选择候选状态序列;

12、局部修复与自适应细化的步骤包括:

13、焊缝约束局部修复的子步骤:执行焊缝约束下的局部修复;

14、焊缝跟踪验证与自适应细化的子步骤:进行焊缝跟踪验证和误差驱动的自适应细化;

15、轨迹后处理与输出的步骤:拼接、最终验证和轨迹输出。

16、进一步的,所述机器人状态建模的步骤具体为,读取机器人工作站的统一机器人描述文件,根据关节名称和拓扑关系,将机械臂关节与外部轴关节映射为统一的n维关节状态向量

q,对于带外部轴的机器人,将机械臂关节和外部轴统一表示为:

17、

18、其中,为焊接机器人工作站的统一关节状态向量,为外部轴的关节状态向量,为机械臂的关节状态向量,

n为机械臂关节与外部轴关节构成的总自由度;

19、同时建立关节状态与输入输出字段之间的名称映射,使内部优化顺序与外部报告顺序相互独立;

20、环境场景由一个或多个网格模型、基本几何体、点云占据体或其他碰撞对象构成;机器人连杆、工具碰撞体和环境对象被加载到碰撞检测后端,并建立允许碰撞对、排除相邻连杆对及安全距离参数。

21、进一步的,所述焊接位姿序列生成的子步骤具体为,获取工艺参数;根据工艺参数中的焊缝起点、焊缝终点以及预设的焊缝离散步长,将连续焊缝划分为多个顺序排列的焊接目标点,焊缝离散点数量表示为:

22、

23、其中,

n为焊缝离散点数量,为焊缝起点的位置向量,为焊缝终点的位置向量,为相邻焊缝目标点之间的预设离散步长,为焊缝方向向量的平方长度,为向上取整运算;

24、沿焊缝按弧长或参数化进度生成多个目标位置,并根据允许的姿态偏差为每个位置生成一个或多个工具目标姿态;由此形成按焊缝进度排列的目标焊接位姿层。

25、进一步的,所述分层逆运动学求解的子步骤具体为,针对每个目标焊接位姿,按照由高成功概率、低计算代价到低成功概率、高计算代价的顺序生成逆运动学初始种子,并求取多个满足位置误差、姿态误差、关节限位和单状态碰撞约束的关节候选;

26、当某一焊点已获得预定数量的有效候选,或达到该焊点的候选数、种子数、迭代次数或时间预算时,停止继续扩展,从而减少无效逆解计算;第一焊点可采用更宽的目标预定位和外部轴布局搜索,后续焊点优先保持与上一层候选的构型连续性。

27、进一步的,所述步骤4具体为,针对第一目标焊接位姿的每个逆解候选,沿预定接近方向或工具轴反向生成一个或多个接近位姿,并通过逆运动学获得接近入口状态及接近段关节序列;随后检查当前关节状态至接近入口状态的自由空间转移;接近可行性指标定义为:

28、

29、其中,为第一焊点第

j个候选构型的接近可行性指标,为机器人当前关节状态,为第

j个候选构型对应的接近入口状态,为当前状态至接近入口状态的自由空间转移轨迹,为接近入口至焊缝起点的接近轨迹,为满足关节限位和碰撞约束的自由构型空间;

30、若当前状态与接近入口状态之间的关节空间直线插值满足关节限位和碰撞约束,则将该直连转移作为候选关联的接近轨迹;若直连不满足约束且允许采样规划,则在统一n维关节空间内执行双向快速扩展随机树连接规划,获得当前状态至接近入口状态的无碰撞转移路径;再将该转移路径与笛卡尔接近段拼接,并验证完整接近轨迹。

31、进一步的,所述冗余逆解候选图构建的子步骤具体为,将第

i个焊接位姿对应的各关节候选作为候选图第

i层的节点;节点属性至少包括关节状态、目标位姿误差、关节限位余量、碰撞安全间距、外部轴位置、焊枪姿态偏差和候选来源;第一层节点还包括接近可行性及接近轨迹代价;为评价每一个候选构型自身的质量,本发明为第

i个焊缝离散点的第

j个候选构型设置节点代价:

32、

33、其中,为第

i层焊第

j个候选构型的节点代价,为第

i个焊缝离散点的第

j个候选关节构型,为候选构型的tcp位置误差,为候选构型的tcp姿态误差,为关节纤维风险代价,为碰撞间距代价,为外部轴使用代价,为奇异性风险代价,分别为对应评价项的非负权重;

34、在相邻焊点的候选节点之间建立有向层间边。

35、进一步的,所述碰撞感知动态规划的子步骤具体为,对分层候选图执行动态规划;对于第

i层候选节点

j,其累计代价由本节点代价与上一层可行前驱节点的累计代价和层间边代价之和的最小值确定;可表示为:

36、

37、其中,为第

i层焊第

j个候选构型的最小累计代价,为当前候选构型的节点代价,为能够与当前候选构型件建立有效连接的前驱候选集合,为第

i-1层的候选构型编号,为到达前一层第

k个候选构型时的最小累计代价,为前一层候选构型至当前候选构型的层间边代价。

38、进一步的,所述焊缝约束局部修复的子步骤具体为,当所选候选状态序列在局部连续碰撞检查中发现碰撞或安全间距不足时,定位包含问题段的局部窗口,并在不改变窗口外已验证轨迹的条件下,调整窗口内的外部轴状态、冗余关节状态或候选组合;修复候选需同时满足窗口首尾边界连接、焊缝目标位姿、关节限位及碰撞约束;

39、焊接段不采用使工具中心点偏离焊缝的普通自由空间绕行作为默认替代路径;自由空间采样规划主要用于当前状态到接近入口的转移段及可选离开段;焊接段的避障通过冗余构型、外部轴联合运动和局部候选重选实现;

40、所述焊缝跟踪验证与自适应细化的子步骤具体为,对相邻焊接关节状态之间的插值状态计算正运动学,获得工具中心点位置和姿态;至少计算工具中心点到目标焊缝的几何距离、与焊缝进度对应的同步位置误差、沿焊缝方向的单调性及姿态误差;机器人实际tcp姿态与目标焊接姿态之间的旋转角误差表示为:

41、

42、姿态误差约束为:

43、

44、其中,为tcp姿态误差角,为目标焊接姿态的旋转矩阵,为机器人实际tcp姿态的旋转矩阵,为矩阵的迹,为允许的最大焊枪姿态误差;

45、若某一轨迹段的误差超过阈值,则在对应焊缝参数位置插入一个或多个新的目标焊接位姿,并在局部范围内重新生成逆解候选、选择连接和执行碰撞检查;该过程在达到误差要求、最大细化深度、最大焊点数或时间预算时停止。

46、进一步的,所述轨迹后处理与输出的步骤具体为,将当前状态至焊缝起点的接近轨迹、选定的焊接轨迹以及可选的离开轨迹进行拼接,删除相邻段之间的重复状态;对最终轨迹执行完整关节限位检查、机器人自碰撞检查、机器人与环境碰撞检查以及必要的安全距离计算;连续碰撞采样数量可根据各关节变化、外部轴位移、几何扫掠上界或端点安全间距自适应确定;

47、最终轨迹通过验证后,根据各关节速度、加速度及加加速度限制进行时间参数化,输出机械臂轨迹、外部轴轨迹、工具中心点轨迹、接近段、焊接段、离开段、完整轨迹以及各阶段可达性、碰撞、误差和性能诊断报告。

48、一种基于冗余构型图优化的焊接机器人约束轨迹规划系统,所述系统使用如上述基于冗余构型图优化的焊接机器人约束轨迹规划方法,所述系统包括:

49、机器人状态建模模块:建立统一的多自由度机器人状态模型;

50、候选生成与预处理模块:生成焊接位姿序列及姿态候选;分层生成冗余逆运动学候选;将接近可行性融合到第一焊点候选筛选;

51、冗余构型图构建与全局规划模块:构建冗余逆解候选图;通过碰撞感知动态规划选择候选状态序列;

52、局部修复与自适应细化模块:执行焊缝约束下的局部修复;进行焊缝跟踪验证和误差驱动的自适应细化;

53、轨迹后处理与输出模块:拼接、最终验证和轨迹输出。

54、本发明的有益效果是:

55、本发明将当前状态到焊缝起点候选的接近轨迹规划结果作为第一层候选的准入条件和优化代价,而不是在焊缝轨迹确定后再独立规划接近段。

56、本发明在每个焊点保留多个机械臂与外部轴联合构型,通过分层候选图选择整条焊缝上的连续构型序列,降低单一滚动逆解过早丢失可行分支的风险。

57、本发明按滚动种子、前层beam、典型构型、外部轴偏移、零空间扰动及低差异补充的顺序扩展,并在获得足够候选后提前停止。

58、本发明通过代价下界排序、懒惰边碰撞检查、边结果缓存和受限前驱重试减少候选图中的精确碰撞查询。

59、本发明统一规划6-9轴机器人的路径逻辑,自适应识别自由度与扰动自动决策。

60、本发明根据插值状态的工具中心点几何误差和姿态误差定位问题段,插入新的焊接目标并进行局部重新求解。

61、本发明同时利用机械臂冗余自由度和外部轴运动能力,在保持工具中心点焊缝约束的前提下扩大可达空间并降低碰撞风险。

62、本发明保持相邻焊点之间的构型连续性,减少肘部翻转、腕部突变和外部轴无序跳变。

63、本发明通过懒惰碰撞检查和候选提前停止机制,避免对大量无效种子和不可能成为最优路径的层间边执行完整检查。

64、本发明支持运行时可变自由度和统一关节名称映射,能够适配不同机器人工作站模型,降低针对单一设备重新开发的工作量。