一种面向大尺寸变曲率复材罩体喷漆的轨迹规划方法与流程

摘要: 本发明属于工业机器人自动化喷漆,尤其涉及一种面向大尺寸变曲率复材罩体喷漆的轨迹规划方法。背景技术:1、随着复合材料在航空航天领域的广泛应用,大尺寸变曲率复材罩体...
一种面向大尺寸变曲率复材罩体喷漆的轨迹规划方法与流程

本发明属于工业机器人自动化喷漆,尤其涉及一种面向大尺寸变曲率复材罩体喷漆的轨迹规划方法。

背景技术:

1、随着复合材料在航空航天领域的广泛应用,大尺寸变曲率复材罩体的表面喷漆质量直接影响产品的气动性能、电磁特性和使用寿命。这类工件通常具有以下特点:(1)尺寸大:直径可达数米至十余米,超出单台工业机器人的工作范围;(2)曲率变化剧烈:从顶部小曲率球面到底部大曲率过渡面,曲率半径变化可达数倍;(3) 表面精度要求高:漆膜厚度公差通常要求严格,且不允许出现流挂、针孔等缺陷;(4) 复合材料特性:表面能低、导热性差,对喷漆工艺参数敏感。

2、目前,大尺寸复材罩体的喷漆主要采用两种方式:一是人工喷漆:依赖工人经验,漆膜厚度均匀性差,质量较低,生产效率低,且漆雾对工人健康危害大,安全性较差;二是单机器人+转台式喷漆:转台带动工件旋转,机器人在固定位置进行喷漆。然而机器人轨迹与转台运动多为独立控制,未实现真正的联动优化。在变曲率区域,由于转台转速恒定、机器人喷枪速度不变,导致凹面区域漆膜过厚、凸面区域漆膜过薄,严重影响产品质量。

技术实现思路

1、为了解决现有技术中人工喷漆质量较低、生产效率低、安全性较差;单机器人+转台式喷漆方式产品质量较差的技术问题,本发明提供一种面向大尺寸变曲率复材罩体喷漆的轨迹规划方法,实现机器人与转台的协同运动控制,所述技术方案如下:

2、一种面向大尺寸变曲率复材罩体喷漆的轨迹规划方法,包括:

3、(1)基于大尺寸变曲率复材罩体的三维模型进行曲率分区,对每个分区生成初始喷涂路径;

4、(2)建立机器人-转台联动运动学模型,采用分层求解法进行联动运动学模型的逆运动学求解,获得有序路径点处机器人关节角和转台转角;

5、(3)建立机器人-转台相对速度的非线性映射关系,计算有序路径点处机器人关节速度与转台转角速度;

6、(4)采用全局前瞻与局部前瞻结合法对机器人-转台联动轨迹进行优化与前瞻平滑处理,获得机器人和转台每个插补周期的转台转角和机器人关节角度的位移增量。

7、其中,(1)具体为:

8、步骤11、将大尺寸变曲率复材罩体的三维模型导入仿真软件;

9、步骤12、计算模型表面各点平均曲率;

10、步骤13、根据平均曲率的大小将大尺寸变曲率复材罩体表面划分为若干个平均曲率连续的区域,并按所有平均曲率的取值范围将其划分为小曲率区域、中曲率区域和大曲率区域,每个区域的平均曲率分别为;

11、步骤14、对小曲率区域、中曲率区域和大曲率区域分别生成初始喷涂路径,给定喷涂路径间距基准为,每个分区的初始喷涂路径间距根据当前区域平均曲率计算:

12、

13、步骤15、利用步骤14计算的初始喷涂路径间距在小曲率区域、中曲率区域和大曲率区域内分别沿曲面生成等距喷涂路径,得到有序路径点。

14、其中,(2)具体为:

15、步骤21、建立世界坐标系、转台坐标系、大尺寸变曲率复材罩体工件坐标系、机器人基坐标系和喷枪工具坐标系;

16、步骤22、通过齐次坐标变换矩阵关联步骤21建立的各坐标系之间的位姿关系,构建机器人-转台联动的位置关系模型:

17、确定大尺寸变曲率复材罩体工件坐标系相对于世界坐标系的变换矩阵,为转台坐标系相对于世界坐标系的变换矩阵,为大尺寸变曲率复材罩体工件坐标系相对转台坐标系的变换矩阵;

18、建立喷枪工具坐标系相对于大尺寸变曲率复材罩体工件坐标系的变换方程,为喷枪工具坐标系相对于机器人基坐标系的变换矩阵,为机器人基坐标系相对于世界坐标系的变换矩阵;

19、步骤23、基于转台转角和机器人关节角的位置关系模型,建立机器人-转台联动的速度关系模型:设机器人关节速度为,转台角速度,喷枪工具坐标系相对于大尺寸变曲率复材罩体工件坐标系的笛卡尔空间线速度为,笛卡尔空间角速度为,则机器人-转台联动的速度关系模型为:

20、

21、其中,是机器人-转台关节空间与笛卡尔空间速度变换的联动雅克比矩阵;

22、步骤24、用分层求解法求解机器人-转台联动运动学模型逆运动学:

23、步骤25、输出每个有序路径点处的转台转角和机器人关节角。

24、其中,步骤24用分层求解法求解机器人-转台联动运动学模型逆运动学,具体为:

25、有序路径点每个路径点均包含笛卡尔空间位置和法向姿态,对于每一个路径点,将其投影到转台的水平回转平面,计算该点投影矢量与转台零角方向的夹角,该夹角即为该有序路径点的转角初始值,

26、

27、对第个有序路径点,代入转角初始值,将大尺寸变曲率复材罩体工件坐标系下的路径点位置与法向姿态,转换为机器人基坐标系下的路径点位置与法向姿态:

28、

29、为转台坐标系在世界坐标系下的旋转矩阵,是大尺寸变曲率复材罩体工件坐标系在转台坐标系下的旋转矩阵,为大尺寸变曲率复材罩体工件坐标系原点与转台坐标系原点的位置矩阵,是机器人基坐标系原点与世界坐标系原点的位置矩阵;

30、将机器人基坐标系下的路径点位置与法向姿态作为求解机器人逆运动学的输入,调用机器人逆运动学算法,求解满足关节限位的机器人关节角,若存在多组逆解,选取关节角度变化量最小的一组;若当前转台转角条件下不存在满足关节限位的机器人关节角,则通过在转台转角初始值基础上加减固定步长()的方式微调转台转角,重新执行转换路径点位置和法向姿态及求解机器人逆运动学,直至找到满足关节限位的转台转角和机器人关节角,从而完成联动运动学模型逆运动学求解。

31、其中,

32、,

33、转台角速度对应笛卡尔空间线速度雅克比分矩阵,

34、

35、,是喷枪坐标系原点在大尺寸变曲率复材罩体工件坐标系下的坐标;

36、关节速度对应笛卡尔空间线速度雅克比分矩阵:

37、

38、是大尺寸变曲率复材罩体工件坐标系相对于世界坐标系的旋转矩阵;是机器人基坐标系在世界坐标系的旋转矩阵;是机器人基坐标系雅克比矩阵的笛卡尔空间线速度部分;

39、转台角速度对应笛卡尔空间角速度雅克比分矩阵:

40、

41、关节速度对应笛卡尔空间角速度雅克比分矩阵:

42、

43、是机器人基坐标系雅克比矩阵的笛卡尔空间角速度部分。

44、其中,(3)具体为:

45、步骤31、合成喷枪相对于大尺寸变曲率复材罩体工件表面的喷枪切线速度:,

46、其中,为机器人末端喷枪速度沿喷涂路径切线方向的分量,是转台带动大尺寸变曲率复材罩体工件运动的线速度沿喷涂路径切线方向的分量,是当前路径点到转台轴线的垂直距离,

47、

48、步骤32、基于合成的喷枪切线速度公式,推导出转台角速度的计算公式:通过给定喷枪相对切线速度,给定机器人末端喷枪切向速度,基于有序路径点位置,计算每个路径点对应的转台目标速度:

49、

50、结合步骤(1)曲率分区结果,对喷枪相对切向速度进行自适应调整,调整规则为:

51、小曲率区:

52、中曲率区:

53、大曲率区:

54、步骤33、基于转台角速度,根据步骤(2)推导的联动雅可比矩阵,将已确定的转台角速度代入联动雅可比矩阵,求解机器人关节速度。

55、步骤34、输出每个有序路径点处的转台转角速度和机器人关节速度。

56、其中,(4)具体为:

57、步骤41、采用全局前瞻法分别处理曲率分区之间的转台转角速度和机器人关节速度差距:识别相邻曲率分区的速度差距,若相邻分区速度差距小于速度差距上限值,直接衔接;若相邻分区速度差距大于速度差距上限值,增加速度过渡段,给定过渡段弧长,在过渡段内采用五次多项式算法生成连续速度曲线;

58、步骤42、采用局部前瞻法分别处理曲率分区内的转台转角速度和机器人关节速度差距:设定前瞻窗口点数,从当前路径点处开始向后读取个路径点,通过给定速度约束:最大加加速度、最大加速度和最大速度限制,采用逐点计算每个前瞻窗口内的速度曲线;如果速度曲线满足速度约束,则完成该前瞻窗口的计算;如果速度曲线不满足速度约束,则根据前瞻窗口内的最低速度限制点,以该点的限制速度为终点的目标速度,根据两点之间的弧长、速度约束,采用五次多项式法计算当前路径点的最大允许速度;然后基于当前路径点的最大允许速度沿前瞻窗口从后向前逐点计算出窗口内所有路径点的速度上限,直至完成所有路径点的速度上限前瞻计算,输出转台角速度和机器人关节速度的新的局部前瞻速度约束;

59、步骤43、基于新的局部前瞻速度约束,采用标准七段式s型加减速算法生成转台转角速度和机器人关节速度的连续速度曲线,将连续速度曲线按照机器人插补周期进行离散化,得到每个插补周期的转台转角和机器人关节角的位移增量。

60、其中,

61、世界坐标系表示该喷漆系统的基准坐标系,原点固定在转台台面的中心,z轴竖直向上,x轴和y轴位于转台台面;

62、转台坐标系表示与转台台面固连的随动坐标系,原点与世界坐标系原点重合,转台坐标系初始姿态与世界坐标系一致,转台旋转时,转台坐标系绕世界坐标系z轴同步转动,转角记为;

63、大尺寸变曲率复材罩体工件坐标系表示固连在大尺寸变曲率复材罩体上的随动坐标系,原点位于工件回转轴线与转台台面的相交点,将大尺寸变曲率复材罩体回转中心与转台台面中心对准安装后,大尺寸变曲率复材罩体工件坐标系与转台坐标系相对位置固定,随转台同步旋转;

64、机器人基坐标系表示固定在工业机器人底座中心的坐标系,是工业机器人的基准坐标系;

65、喷枪工具坐标系表示固连在喷漆系统中喷枪末端的工具坐标系,原点位于喷枪末端出漆面的中心,z轴沿喷枪出漆方向,且垂直于喷枪末端出漆面。

66、本发明的有益效果至少在于:

67、(1)实现机器人-转台联动控制:建立统一运动学模型,解决了机器人与转台独立控制、运动不同步的问题,可覆盖单机器人工作范围外的大尺寸工件;

68、(2)机器人末端喷枪相对工件速度高度平稳:通过非线性速度映射,保证喷枪相对工件的切线速度恒定,从运动层面保障喷涂均匀性;

69、(3)求解方便易实施:采用分层求解的方法求解机器人-转台联动运动学模型逆运动学逆解,兼容工业机器人逆运动学算法,无需复杂寻优,可靠性高;

70、(4)插补轨迹平顺无冲击:采用全局前瞻+局部前瞻+ s 型加减速的速度规划方法,解决曲率突变处的速度跳变问题,提升运行稳定性;

71、(5)喷漆轨迹自适应适配工件表面曲率:路径间距随工件表面曲率自动调整,兼顾大曲率区域的喷漆覆盖质量与小曲率区域的作业效率;

72、(6)通用性强:可适配不同尺寸、不同曲率的回转类复材罩体工件,调整参数即可快速生成新的喷涂轨迹。