坡口场景的机器人轨迹生成方法、存储介质和终端设备与流程

摘要: 本技术涉及机器人控制,特别是涉及坡口场景的机器人轨迹生成方法、存储介质和终端设备。背景技术:1、在坡口切割、打磨等机器人自动化加工场景中,机器人程序的生成是决定...
坡口场景的机器人轨迹生成方法、存储介质和终端设备与流程

本技术涉及机器人控制,特别是涉及坡口场景的机器人轨迹生成方法、存储介质和终端设备。

背景技术:

1、在坡口切割、打磨等机器人自动化加工场景中,机器人程序的生成是决定加工效率和质量的关键环节。随着工件形状日益复杂、加工精度要求不断提高,如何高效、准确地从坡口几何信息生成机器人可执行的运动轨迹,已成为本领域亟待解决的重要技术问题。

2、目前,机器人坡口作业程序主要通过以下几种方式生成。人工示教方式由操作人员手动拖动机器人末端,沿坡口路径逐点记录点位坐标与工艺参数,形成可执行程序,但该方式效率低下,对操作人员经验依赖度高,且难以保证复杂空间曲线下的轨迹精度。离线编程方式以工件三维设计模型为输入,操作人员在模型上人工选取坡口边线并设定工具姿态与工艺参数,经仿真后输出程序,但该方式依赖于完整准确的三维模型,对于无模型或模型与实物存在偏差的场景适应性不足。

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、当坡口侧别为下侧坡口时,以所述坡口点的基础位姿为基准,将所述基础位姿绕局部第三轴向旋转第一预设角度,并绕局部第一轴向旋转第二预设角度,得到偏置后的第二位姿信息;

27、根据所述工艺参数中的坡口宽度、割缝宽度、切割高度、板厚和坡口角度,计算所述基础位姿的目标偏移量;

28、以所述偏置后的第二位姿信息和所述目标偏移量构成下侧坡口的工具目标位姿信息。

29、在一实施例中,生成所述进刀点和所述退刀点的步骤,包括:

30、根据所述坡口点序列的加工方向,确定加工起始点和加工终止点;

31、以所述加工起始点为基准,沿所述加工方向的反方向并结合所述工艺参数中的进刀角度和进刀距离,生成所述进刀点;

32、以所述加工终止点为基准,沿所述加工方向的反方向并结合所述工艺参数中的退刀角度和退刀距离,生成所述退刀点。

33、在一实施例中,所述获取规划请求的步骤之后,还包括:

34、当所述命令类型为拍照轨迹命令时,根据拍照点的方向信息确定初始参考方向,并根据所述初始参考方向构建相机局部旋转矩阵;

35、根据所述相机局部旋转矩阵和所述拍照点的位置信息,生成所述相机在机器人基坐标系下的目标位姿,并将所述目标位姿转换为机器人的法兰目标位姿;

36、在所述法兰目标位姿的基础上,沿机器人所在坐标系的竖直向上方向增加安全距离,得到拍照安全位姿;

37、以所述机器人初始驱动参数为起始参考,分别对所述法兰目标位姿和所述拍照安全位姿进行运动学求解,得到各拍照点的驱动参数以及各拍照安全位姿对应的驱动参数;

38、将各所述拍照点的驱动参数和各所述拍照安全位姿对应的驱动参数封装为拍照轨迹数据并返回。

39、本技术提供的坡口场景的机器人轨迹生成方法、存储介质和终端设备至少具备以下技术效果:

40、(1)能够根据命令类型分别生成精定位拍照轨迹和坡口作业轨迹,视觉系统和相关机器人软件无需内嵌坡口轨迹算法,便于各模块独立升级。

41、(2)由点位法向、工件全局参考方向、坡口侧别及工艺角度共同确定,可适应空间方向变化的真实坡口点序列。上下侧坡口分别采用与坡口角度、坡口宽度、切割高度、割缝宽度和板厚关联的工艺偏置,可直接生成符合实际坡口几何关系的工具目标位姿。

42、(3)自动生成进刀、作业、退刀、安全避让和跨段过渡轨迹,并将轨迹段与工艺参数码绑定,减少在机器人软件中手工补充轨迹逻辑的工作量。

43、(4)通过位姿插值、逐点逆解及关节连续性约束,降低机器人在相邻轨迹点之间发生逆解分支跳变和腕部翻转的风险。

44、(5)对带直线附加轴的机器人工作站,可根据目标位置投影自动分配附加轴位移与六轴机器人目标位置,扩大坡口轨迹的可达范围。生成结果通过http返回现有机器人软件进行离线虚拟调试,可在占用真实机器人之前发现明显的不可达、碰撞或轨迹不合理问题,降低现场调试成本。

45、(6)提高了机器人轨迹的生成效率以及所生成的机器人轨迹的准确率。