CN110465949B - 焊接机器人及其摆动轨迹的规划方法 - Google Patents
焊接机器人及其摆动轨迹的规划方法 Download PDFInfo
- Publication number
- CN110465949B CN110465949B CN201910849527.4A CN201910849527A CN110465949B CN 110465949 B CN110465949 B CN 110465949B CN 201910849527 A CN201910849527 A CN 201910849527A CN 110465949 B CN110465949 B CN 110465949B
- Authority
- CN
- China
- Prior art keywords
- coordinate system
- track
- welding
- swing
- points
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000003466 welding Methods 0.000 title claims abstract description 159
- 238000000034 method Methods 0.000 title claims abstract description 44
- 230000006870 function Effects 0.000 claims description 12
- 238000004891 communication Methods 0.000 claims description 9
- 239000011159 matrix material Substances 0.000 claims description 4
- 230000009466 transformation Effects 0.000 claims description 4
- 238000004364 calculation method Methods 0.000 abstract description 4
- 230000008569 process Effects 0.000 description 9
- 238000010586 diagram Methods 0.000 description 7
- 238000009941 weaving Methods 0.000 description 5
- 230000008859 change Effects 0.000 description 2
- 230000010355 oscillation Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000003631 expected effect Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Manipulator (AREA)
- Numerical Control (AREA)
Abstract
本申请公开了一种焊接机器人及其摆动轨迹的规划方法,该规划方法包括:确定焊缝上多个第一轨迹点在工件坐标系下的第一位置坐标和第一姿态坐标;确定多个第一轨迹点各自对应的第二轨迹点在摆动坐标系下的位置坐标,其中,多个第一轨迹点各自对应的第二轨迹点在摆动坐标系下形成位于XOY平面的椭圆型偏移轨迹;将第二轨迹点在摆动坐标系下的位置坐标转换为在工件坐标系下的第二位置坐标;叠加第一轨迹点的第一位置坐标与对应的第二轨迹点的第二位置坐标,得到与第一轨迹点对应的插补点在工件坐标系下的位置坐标;根据插补点确定规划后的摆动轨迹。本申请所提供的摆动轨迹的规划方法计算简单。
Description
技术领域
本申请涉及焊接机器人技术领域,特别是涉及一种焊接机器人及其摆动轨迹的规划方法。
背景技术
焊接机器人的摆动焊接(简称摆焊)是焊枪沿着焊缝方向行进的同时纵向以一定规律摆动的焊接方式。它提高了焊接强度和焊接效率,在自动化焊接技术中得到广泛应用,具有实际工程意义。
本申请的发明人发现,目前焊接机器人摆动轨迹的规划方法计算复杂,且很难保证焊接机器人在摆动焊接过程中达到预期的速度与预期的周期。
发明内容
本申请主要解决的技术问题是提供一种焊接机器人及其摆动轨迹的规划方法,能够简化计算方法。
为解决上述技术问题,本申请采用的一个技术方案是:提供一种焊接机器人摆动轨迹的规划方法,所述摆动轨迹的规划方法包括:确定焊缝上多个第一轨迹点在工件坐标系下的第一位置坐标和第一姿态坐标;确定多个所述第一轨迹点各自对应的第二轨迹点在摆动坐标系下的位置坐标,其中,多个所述第一轨迹点各自对应的第二轨迹点相对所述焊缝存在偏移增量,且多个所述第一轨迹点各自对应的第二轨迹点在所述摆动坐标系下形成位于XOY平面的椭圆型偏移轨迹,所述椭圆型偏移轨迹的短轴与所述摆动坐标系的X轴重合;将所述第二轨迹点在所述摆动坐标系下的位置坐标转换为在所述工件坐标系下的第二位置坐标;叠加所述第一轨迹点的所述第一位置坐标与对应的所述第二轨迹点的所述第二位置坐标,得到与所述第一轨迹点对应的插补点在所述工件坐标系下的位置坐标,其中,所述插补点的姿态坐标为所述第一姿态坐标;根据所述插补点的位置坐标和姿态坐标确定规划后的摆动轨迹;其中,所述摆动坐标系为工具坐标系,其原点为焊枪的端点,X轴方向为所述焊枪的前进方向、Y轴方向为所述焊枪的摆动方向,Z轴方向为所述焊枪的枪头方向;或,所述摆动坐标系为工具路径坐标系,其原点为所述焊枪的端点,X轴方向为所述焊缝的切线方向,Y轴方向由所述工具路径坐标系的X轴方向与所述工具坐标系的Z轴方向叉乘确定,Z轴方向由所述工具路径坐标系的X轴方向与Y轴方向叉乘确定。
为解决上述技术问题,本申请采用的另一个技术方案是:提供一种焊接机器人,包括处理器、存储器以及通信电路,所述处理器分别耦接所述存储器以及所述通信电路,所述处理器在工作时控制自身以及所述存储器、所述通信电路实现上述方法中的步骤。
为解决上述技术问题,本申请采用的另一个技术方案是:提供一种具有存储功能的装置,存储有程序数据,所述程序数据能够被执行以实现上述方法中的步骤。
本申请的有益效果是:本申请焊接机器人摆动轨迹的规划方法将焊接机器人的摆动轨迹进行了拆分,拆分为焊缝轨迹和偏移轨迹,相比现有技术无需将每个转折点作为示教终点,计算简单,另外,多个第二轨迹点在摆动坐标系下形成位于XOY平面的椭圆型偏移轨迹,该椭圆型偏移轨迹的短轴与摆动坐标系的X轴重合,从而可以实现焊接机器人的平面圆弧形摆动。
附图说明
为了更清楚地说明本申请实施例中的技术方案,下面将对实施例描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本申请的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。其中:
图1是本申请焊接机器人摆动轨迹的规划方法一实施方式的流程示意图;
图2是工具坐标系的示意图;
图3是工具路径坐标系的示意图;
图4是本申请焊接机器人在摆动坐标系下的偏移轨迹示意图;
图5是本申请焊接机器人在工件坐标系下的摆动轨迹示意图;
图6是本申请焊接机器人一实施方式的结构示意图;
图7是本申请具有存储功能的装置一实施方式的结构示意图。
具体实施方式
下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本申请一部分实施例,而不是全部实施例。基于本申请中的实施例,本领域普通技术人员在没有做出创造性的劳动前提下所获得的所有其他实施例,都属于本申请保护的范围。
参阅图1,图1是本申请焊接机器人摆动轨迹的规划方法一实施方式的流程示意图。本申请中摆动轨迹的规划方法的执行主体为焊接机器人,该规划方法包括:
S110:确定焊缝上多个第一轨迹点在工件坐标系下的第一位置坐标和第一姿态坐标。
焊缝为两个待焊接工件的固定连接处,焊接机器人在焊接两个待焊接工件的过程中沿着焊缝延伸方向前进并相对焊缝进行纵向摆动。工件坐标系是固定于工件上的笛卡尔坐标系,由设计人员进行设定,在不同的应用场景中,设计人员可设定不同的工件坐标系。多个第一轨迹点位于焊缝上,其相对焊缝而言没有偏移,多个第一轨迹点形成与焊缝完全重合的焊缝轨迹。
在一应用场景中,在进行示教的过程中,焊接机器人根据操作人员输入的焊接起点的位姿、焊接终点的位姿以及焊接时长/焊接速度,确定焊缝上多个第一轨迹点在工件坐标下的位姿,该位姿包括多个第一轨迹点的第一位置坐标和第一姿态坐标。其中焊接起点和终点均位于焊缝上,焊接时长为焊缝轨迹的焊接时长,即期望焊接机器人从焊接起点沿着焊缝走到焊接终点的时长,焊接速度为期望焊接机器人沿着焊缝轨迹行走时的线速度。
S120:确定多个第一轨迹点各自对应的第二轨迹点在摆动坐标系下的位置坐标,其中,多个第一轨迹点各自对应的第二轨迹点相对焊缝存在偏移增量,且多个第一轨迹点各自对应的第二轨迹点在摆动坐标系下形成位于XOY平面的椭圆型偏移轨迹,椭圆型偏移轨迹的短轴与摆动坐标系的X轴重合。
第二轨迹点相对焊缝而言存在偏移,多个第一轨迹点与多个第二轨迹点之间具有一一对应关系,多个第二轨迹点形成焊接机器人在摆动坐标系下的偏移轨迹。
其中摆动坐标系可以为工具坐标系或工具路径坐标系,如图2所示,工具坐标系的原点为焊接机器人的焊枪的端点,即为工具中心点(TCP,Tool center point),其X轴方向为焊枪的前进方向、Y轴方向为焊枪的摆动方向,Z轴方向为焊枪的枪头方向。
或者,摆动坐标系还可以为工具路径坐标系,如图3所示,与工具坐标系相同的是,工具路径坐标系的原点也为焊接机器人的焊枪的端点,与工具坐标系不同的是,其X轴方向为焊缝A的切线方向,Y轴方向由工具路径坐标系的X轴方向与工具坐标系的Z轴方向叉乘确定,Z轴方向由工具路径坐标系的X轴方向与Y轴方向叉乘确定。
其中值得注意的是,工具坐标系适用于任何应用场景,而工具路径坐标系在当焊缝A的切线方向与工具坐标系的Z轴方向平行时无法适用。
在焊接机器人焊接的过程中,其焊枪会进行旋转(在旋转过程中,其枪头方向不变),此时如果将摆动坐标系选择为工具坐标系,则摆动坐标系会绕其Z轴旋转,即导致X轴方向和Y轴方向发生改变,进而导致多个第二轨迹点在摆动坐标下的位置坐标发生改变,最终导致焊接机器人的偏移轨迹发生改变。而由于焊枪旋转时,其工具坐标系的Z轴方向不会改变,又由于工具路径坐标系只与工具坐标系的Z轴方向相关,因此若不想焊接机器人的偏移轨迹随着焊枪的旋转而发生变化,则可将摆动坐标系选择为工具路径坐标系。
S130:将第二轨迹点在摆动坐标系下的位置坐标转换为在工件坐标系下的第二位置坐标。
由于两个坐标系之间可以互相转换,因此可以将第二轨迹点在摆动坐标系下的位置坐标转换为在工件坐标系下的第二位置坐标。
S140:叠加第一轨迹点的第一位置坐标与对应的第二轨迹点的第二位置坐标而得到与第一轨迹点对应的插补点在工件坐标系下的位置坐标,其中,插补点的姿态坐标为第一姿态坐标。
第一轨迹点、第二轨迹点和插补点之间具有一一对应关系。
S150:根据插补点的位置坐标和姿态坐标确定规划后的摆动轨迹。
焊接机器人根据焊接起点、焊接终点和插补点形成摆动轨迹,在确定好摆动轨迹后,焊接机器人按照该摆动轨迹进行焊接。插补点在工件坐标系下的位置坐标为第一轨迹点的第一位置坐标叠加对应的第二轨迹点的第二位置坐标,即焊接机器人的最终摆动轨迹为焊缝轨迹叠加偏移轨迹,从而相比现有技术,在示教过程中,无需将每个转折点(也称为尖点)作为示教终点,计算简单,且可以保证摆动轨迹的计算时长与用户输入的焊接时长相同,进而可以保证摆动周期,同时由于可以保证焊缝轨迹不变,因此能够保证摆动轨迹的焊接速度与用户输入的焊接速度相同。
同时在本实施方式中,如图4所示,多个第二轨迹点在摆动坐标系下形成位于XOY平面的椭圆型偏移轨迹10,该椭圆型偏移轨迹10的短轴与摆动坐标系的X轴重合,因此如图5所示,在焊缝轨迹上叠加该椭圆型偏移轨迹10形成的摆动轨迹为平面圆弧型轨迹20,也就是说,在本实施方式中,可以实现焊接机器人的平面圆弧形摆动。
其中,在本实施方式中,将第二轨迹点在摆动坐标系下的位置坐标左乘工件坐标系相对摆动坐标系的转换矩阵而得到第二轨迹点在工件坐标系下的第二位置坐标。具体地,若第二轨迹点在摆动坐标系下的位置坐标为P,则第二轨迹点在工件坐标系下的位置坐标Q=M*P,其中,M为工件坐标系相对摆动坐标系的转换矩阵,该转换矩阵M可以由机器人的运动学正解求得。
因此,若焊缝上多个第一轨迹点在工件坐标系下的第一位置坐标为R,则与第一轨迹点对应的插补点在工件坐标系下的位置坐标为S=R+Q=R+M*P。
其中,在本实施方式中,步骤S120具体包括:
S121:获取焊接时长duration、摆动周期T、摆动振幅A以及摆动半径R。
摆动半径R为椭圆型偏移轨迹10的短轴长度的一半,即椭圆型偏移轨迹10的短半轴长,如图4所示。
在一应用场景中,在规划轨迹之前,机器人直接接收用户输入的焊接时长duration,在另一应用场景中,机器人根据用户输入的焊接起点的位姿、焊接终点的位姿以及焊接速度而计算出焊接时长duration。
S122:计算多个第一轨迹点各自的插补时间点。
该插补时间点为第一轨迹点在整个焊接过程中的时间点。多个第一轨迹点各自的插补时间点均在0~duration之间,第一轨迹点对应的插补时间点越小,表明第一轨迹点越靠近焊接起点。
S123:按照如下公式一计算多个第一轨迹点各自在一个摆动循环内的时间点:
公式一:t=time-round(time/cycle)*cycle,其中,t为多个第一轨迹点各自在一个摆动循环内的时间点,time为多个第一轨迹点各自的插补时间点,round为向下取整函数,cycle为一个摆动循环的时长,cycle=T。
摆动轨迹按照最小的重复单元进行重复变化,该最小的重复单元即为一个摆动循环。与摆动轨迹对应,多个第二轨迹点形成的偏移轨迹也是按照最小的重复单元进行重复变化,其中,摆动轨迹最小的重复单元的时长、起始时间点与多个第二轨迹点形成的偏移轨迹最小的重复单元的时长、起始时间点对应相同。
在本申请中,当焊接机器人进行平面圆弧形摆动时,在偏移轨迹的最小的重复单元内,焊接机器人不会进行停留,因此偏移轨迹的最小的重复单元的时长为T,该时长也为摆动轨迹的最小的重复单元的时长。
S124:以多个第一轨迹点各自在一个摆动循环内的时间点为自变量,运用函数计算多个第一轨迹点各自对应的第二轨迹点在摆动坐标系下沿X轴以及沿Y轴的偏移增量。
以第一轨迹点各自在一个摆动循环内的时间点t为自变量计算对应的第二轨迹点在摆动坐标系下沿X轴的偏移增量以及沿Y轴的偏移增量,即将第一轨迹点各自在一个摆动循环内的时间点t带入函数计算出该第一轨迹点对应的第二轨迹点在摆动坐标系下沿X轴的偏移增量以及沿Y轴的偏移增量。
S125:确定多个第一轨迹点对应的第二轨迹点在摆动坐标系下的位置坐标。
具体地,多个第一轨迹点对应的第二轨迹点在摆动坐标系下的位置坐标P=[X Y0]T,其中,X为第一轨迹点对应的第二轨迹点在摆动坐标系下沿X轴的偏移增量,Y为第一轨迹点对应的第二轨迹点在摆动坐标系下沿Y轴的偏移增量。因此与第一轨迹点对应的插补点在工件坐标系下的位置坐标为S=R+Q=R+M*[X Y 0]T。
在一应用场景中,按照如下公式二计算多个第一轨迹点各自对应的第二轨迹点在摆动坐标系下沿X轴的偏移增量,以及按照如下公式三计算多个第一轨迹点各自对应的第二轨迹点在摆动坐标系下沿Y轴的偏移增量:
公式二:X=-R+R*cos(α);
公式三:Y=A*sin(α);
其中,X为多个第一轨迹点各自对应的第二轨迹点在摆动坐标系下沿X轴的偏移增量,Y为多个第一轨迹点各自对应的第二轨迹点在摆动坐标系下沿Y轴的偏移增量,α=2πt/T。
在每个摆动循环结束时,焊接机器人会回到焊缝上,通常出于工艺的要求,焊接机器人在焊接结束后要求其回到焊缝上,即要求焊接时长是摆动循环的时长cycle的整数倍,但是在一应用场景中,当用户不直接输入焊接时长时,例如焊接机器人根据用户输入的焊接起点的位姿、焊接终点的位姿以及焊接速度而计算出焊接时长时,该焊接时长可能不是摆动循环的时长cycle的整数倍,那么在焊接结束时,焊接器可能会偏移焊缝,达不到预想的效果。因此为了解决该问题,保证在摆动轨迹结束的时候,焊接机器人能够正好运动到焊缝上,本实施方式中的方法还包括:
S160:计算duration与round(duration/cycle)*cycle的差值,并将差值记为mini_cycle。
S170:判断mini_cycle是否为0,若mini_cycle为0,则按照公式二以及公式三计算多个第一轨迹点各自对应的第二轨迹点在摆动坐标系下沿X轴以及沿Y轴的偏移增量,否则对插补时间点大于(duration-mini_cycle)的至少部分第一轨迹点缩小摆动周期、摆动振幅以及摆动半径,以计算对应的第二轨迹点在摆动坐标系下沿X轴以及沿Y轴的偏移增量。
具体地,round为向下取整函数,round(duration/cycle)*cycle为整个焊接过程中所有完整摆动循环的总时长。若mini_cycle为0,则说明焊接时长duration是摆动循环的时长cycle的整数倍,则焊接机器人在焊接结束时必然会回到焊缝上,进而按照公式二以及公式三确定多个第一轨迹点各自对应的第二轨迹点在摆动坐标系下沿X轴以及Y轴的偏移增量。如果mini_cycle不为0,则说明最后一摆动循环不是完整的一个摆动循环,此时存在焊接机器人在结束时不会回到焊缝上的可能性,因此我们需要在最后一个摆动循环内使焊接机器人回到焊缝上,即在最后一个摆动循环内使焊接机器人进行“归零摆动”,其中归零摆动的时长为mini_cycle,起始时间点为(duration-mini_cycle),即当插补时间点小于(duration-mini_cycle)时,焊接机器人按照公式二以及三正常摆动,当插补时间点大于(duration-mini_cycle)时,焊接机器人进行归零摆动,即对插补时间点大于(duration-mini_cycle)的至少部分第一轨迹点缩小摆动周期、摆动振幅以及摆动半径,以计算对应的第二轨迹点在摆动坐标系下沿X轴以及Y轴的偏移增量。
在一应用场景中,对插补时间点大于(duration-mini_cycle)的至少部分第一轨迹点缩小摆动周期、摆动振幅以及摆动半径,以计算对应的第二轨迹点在摆动坐标系下沿X轴以及Y轴的偏移增量的步骤,包括:
对插补时间点大于(duration-mini_cycle)的第一轨迹点,按照mini_cycle/cycle的比例缩小摆动周期、摆动振幅以及摆动半径,以计算对应的第二轨迹点在摆动坐标系下沿X轴以及Y轴的偏移增量。
具体地,按照如下公式四以及五计算对应的第二轨迹点在摆动坐标下沿X轴以及Y轴的偏移增量。
公式四:X=-Rmin+Rmin*cos(β);
公式五:Y=Amin*sin(β);
从上述内容可以看出,通过本实施方式中的方法可以保证焊接机器人在焊接最后回到焊缝上,达到预期的摆动轨迹。
参阅图6,图6是本申请焊接机器人一实施方式的结构示意图。焊接机器人200包括处理器210、存储器220以及通信电路230,处理器210分别耦接存储器220以及通信电路230,处理器210在工作时控制自身以及存储器220、通信电路230实现上述摆动轨迹的规划方法中的步骤,详细的规划方法可参见上述实施方式,在此不再赘述。
参阅图7,图7是本申请具有存储功能的装置一实施方式的结构示意图。具有存储功能的装置300存储有程序数据310,程序数据310能够被执行以实现上述摆动轨迹的规划方法中的步骤,详细的规划方法可参见上述实施方式,在此不再赘述。
总而言之,本申请焊接机器人摆动轨迹的规划方法将焊接机器人的摆动轨迹进行了拆分,拆分为焊缝轨迹和偏移轨迹,相比现有技术无需将每个转折点作为示教终点,计算简单,另外,多个第二轨迹点在摆动坐标系下形成位于XOY平面的椭圆型偏移轨迹,该椭圆型偏移轨迹的短轴与摆动坐标系的X轴重合,从而可以实现焊接机器人的平面圆弧形摆动。
以上所述仅为本申请的实施方式,并非因此限制本申请的专利范围,凡是利用本申请说明书及附图内容所作的等效结构或等效流程变换,或直接或间接运用在其他相关的技术领域,均同理包括在本申请的专利保护范围内。
Claims (9)
1.一种焊接机器人摆动轨迹的规划方法,其特征在于,所述规划方法包括:
确定焊缝上多个第一轨迹点在工件坐标系下的第一位置坐标和第一姿态坐标;
获取焊接时长duration、摆动周期T、摆动振幅A以及摆动半径R;
计算多个所述第一轨迹点各自的插补时间点;
按照如下公式一计算多个所述第一轨迹点各自在一个摆动循环内的时间点:
公式一:t=time-round(time/cycle)*cycle,其中,t为多个所述第一轨迹点各自在一个摆动循环内的时间点,time为多个所述第一轨迹点各自的插补时间点,round为向下取整函数,cycle为一个摆动循环的时长,cycle=T;
以多个所述第一轨迹点各自在一个摆动循环内的时间点为自变量,运用函数计算多个所述第一轨迹点各自对应的第二轨迹点在摆动坐标系下沿X轴以及沿Y轴的偏移增量;
确定多个所述第一轨迹点各自对应的第二轨迹点在所述摆动坐标系下的位置坐标;
其中,多个所述第一轨迹点各自对应的第二轨迹点相对所述焊缝存在偏移增量,且多个所述第一轨迹点各自对应的第二轨迹点在所述摆动坐标系下形成位于XOY平面的椭圆型偏移轨迹,所述椭圆型偏移轨迹的短轴与所述摆动坐标系的X轴重合;
将所述第二轨迹点在所述摆动坐标系下的位置坐标转换为在所述工件坐标系下的第二位置坐标;
叠加所述第一轨迹点的所述第一位置坐标与对应的所述第二轨迹点的所述第二位置坐标,得到与所述第一轨迹点对应的插补点在所述工件坐标系下的位置坐标,其中,所述插补点的姿态坐标为所述第一姿态坐标;
根据所述插补点的位置坐标和姿态坐标确定规划后的摆动轨迹;
其中,所述摆动坐标系为工具坐标系,其原点为焊枪的端点,X轴方向为所述焊枪的前进方向、Y轴方向为所述焊枪的摆动方向,Z轴方向为所述焊枪的枪头方向;或,所述摆动坐标系为工具路径坐标系,其原点为所述焊枪的端点,X轴方向为所述焊缝的切线方向,Y轴方向由所述工具路径坐标系的X轴方向与所述工具坐标系的Z轴方向叉乘确定,Z轴方向由所述工具路径坐标系的X轴方向与Y轴方向叉乘确定。
2.根据权利要求1所述的规划方法,其特征在于,所述以多个所述第一轨迹点各自在一个摆动循环内的时间点为自变量,运用函数计算多个所述第一轨迹点各自对应的所述第二轨迹点在所述摆动坐标系下沿X轴以及沿Y轴的偏移增量的步骤,包括:
按照如下公式二计算多个所述第一轨迹点各自对应的所述第二轨迹点在所述摆动坐标系下沿X轴的偏移增量,以及按照如下公式三计算多个所述第一轨迹点各自对应的所述第二轨迹点在所述摆动坐标系下沿Y轴的偏移增量:
公式二:X=-R+R*cos(α);
公式三:Y=A*sin(α);
其中,X为多个所述第一轨迹点各自对应的第二轨迹点在所述摆动坐标系下沿X轴的偏移增量,Y为多个所述第一轨迹点各自对应的第二轨迹点在所述摆动坐标系下沿Y轴的偏移增量,α=2πt/T。
3.根据权利要求2所述的规划方法,其特征在于,所述获取焊接时长duration的步骤,包括:
根据用户输入的焊接起点的位姿、焊接终点的位姿以及焊接速度而获得所述焊接时长duration。
4.根据权利要求3所述的规划方法,其特征在于,所述方法还包括:
计算duration与round(duration/cycle)*cycle的差值,并将所述差值记为mini_cycle;
判断mini_cycle是否为0,若mini_cycle为0,则按照所述公式二以及所述公式三计算多个所述第一轨迹点各自对应的第二轨迹点在所述摆动坐标系下沿X轴以及沿Y轴的偏移增量,否则对插补时间点大于(duration-mini_cycle)的至少部分第一轨迹点缩小所述摆动周期、所述摆动振幅以及所述摆动半径,以计算对应的第二轨迹点在所述摆动坐标系下沿X轴以及Y轴的偏移增量。
5.根据权利要求4所述的规划方法,其特征在于,所述对插补时间点大于(duration-mini_cycle)的至少部分第一轨迹点缩小所述摆动周期、所述摆动振幅以及所述摆动半径,以计算对应的第二轨迹点在所述摆动坐标系下沿X轴以及Y轴的偏移增量的步骤,包括:
对插补时间点大于(duration-mini_cycle)的第一轨迹点,按照mini_cycle/cycle的比例缩小所述摆动周期、所述摆动振幅以及所述摆动半径,以计算对应的第二轨迹点在所述摆动坐标系下沿X轴以及Y轴的偏移增量。
6.根据权利要求1所述的规划方法,其特征在于,所述将所述第二轨迹点在所述摆动坐标系下的位置坐标转换为在所述工件坐标系下的第二位置坐标,包括:
将所述第二轨迹点在所述摆动坐标系下的位置坐标左乘所述工件坐标系相对所述摆动坐标系的转换矩阵而得到所述第二轨迹点在所述工件坐标系下的所述第二位置坐标。
7.根据权利要求1所述的规划方法,其特征在于,所述确定焊缝上多个第一轨迹点在工件坐标系下的第一位置坐标和第一姿态坐标的步骤,包括:
根据用户输入的焊接起点的位姿、焊接终点的位姿以及焊接时长/焊接速度而获得多个所述第一轨迹点在所述工件坐标系下的所述第一位置坐标和所述第一姿态坐标。
8.一种焊接机器人,其特征在于,包括处理器、存储器以及通信电路,所述处理器分别耦接所述存储器以及所述通信电路,所述处理器在工作时控制自身以及所述存储器、所述通信电路实现如权利要求1-7任一项所述方法中的步骤。
9.一种具有存储功能的装置,其特征在于,存储有程序数据,所述程序数据能够被执行以实现如权利要求1-7任一项所述方法中的步骤。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910849527.4A CN110465949B (zh) | 2019-09-09 | 2019-09-09 | 焊接机器人及其摆动轨迹的规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910849527.4A CN110465949B (zh) | 2019-09-09 | 2019-09-09 | 焊接机器人及其摆动轨迹的规划方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110465949A CN110465949A (zh) | 2019-11-19 |
CN110465949B true CN110465949B (zh) | 2021-11-09 |
Family
ID=68515208
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910849527.4A Active CN110465949B (zh) | 2019-09-09 | 2019-09-09 | 焊接机器人及其摆动轨迹的规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110465949B (zh) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112405527A (zh) * | 2020-10-26 | 2021-02-26 | 配天机器人技术有限公司 | 工件表面圆弧轨迹加工方法及相关装置 |
CN112659121B (zh) * | 2020-12-09 | 2024-03-29 | 北京配天技术有限公司 | 机器人磨轮半径补偿方法、装置、机器人及存储介质 |
CN113305881B (zh) * | 2021-05-14 | 2022-07-12 | 北京配天技术有限公司 | 机器人运动规划阶段的奇异区域检测方法 |
CN114985868B (zh) * | 2022-07-19 | 2024-06-11 | 成都卡诺普机器人技术股份有限公司 | 一种摆弧焊接方法及焊接机器人 |
CN114952869B (zh) * | 2022-07-27 | 2022-11-15 | 法奥意威(苏州)机器人系统有限公司 | 摆动路径规划方法、装置及电子设备 |
CN115453971B (zh) * | 2022-09-23 | 2023-08-15 | 法奥意威(苏州)机器人系统有限公司 | 圆弧摆动路径规划方法、装置及规划设备 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CA2526459C (en) * | 2003-06-02 | 2008-06-17 | Honda Motor Co., Ltd. | Teaching data preparing method for articulated robot |
KR100841822B1 (ko) * | 2007-03-28 | 2008-06-26 | 대우조선해양 주식회사 | 서브머지드아크용접 위빙 장치 |
CN103568012A (zh) * | 2013-10-24 | 2014-02-12 | 安徽埃夫特智能装备有限公司 | 一种弧焊机器人双平面摆弧轨迹的规划方法 |
JP5449112B2 (ja) * | 2010-11-18 | 2014-03-19 | 株式会社神戸製鋼所 | 溶接状況監視方法及び溶接状況監視装置 |
CN105436661A (zh) * | 2015-11-29 | 2016-03-30 | 上海新时达电气股份有限公司 | 摆弧焊接方法及弧焊机器人 |
CN106270946A (zh) * | 2016-09-19 | 2017-01-04 | 南昌大学 | 一种移动焊接机器人焊接矩形角焊缝的方法 |
EP3342523A1 (en) * | 2015-08-25 | 2018-07-04 | Daihen Corporation | Welding method and arc welding device |
CN108941845A (zh) * | 2018-08-28 | 2018-12-07 | 苏州艾利特机器人有限公司 | 一种弧焊机器人空间圆弧摆焊插补方法 |
CN109940623A (zh) * | 2018-10-26 | 2019-06-28 | 广东工业大学 | 一种应用于焊缝的机器人路径规划方法 |
-
2019
- 2019-09-09 CN CN201910849527.4A patent/CN110465949B/zh active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CA2526459C (en) * | 2003-06-02 | 2008-06-17 | Honda Motor Co., Ltd. | Teaching data preparing method for articulated robot |
KR100841822B1 (ko) * | 2007-03-28 | 2008-06-26 | 대우조선해양 주식회사 | 서브머지드아크용접 위빙 장치 |
JP5449112B2 (ja) * | 2010-11-18 | 2014-03-19 | 株式会社神戸製鋼所 | 溶接状況監視方法及び溶接状況監視装置 |
CN103568012A (zh) * | 2013-10-24 | 2014-02-12 | 安徽埃夫特智能装备有限公司 | 一种弧焊机器人双平面摆弧轨迹的规划方法 |
EP3342523A1 (en) * | 2015-08-25 | 2018-07-04 | Daihen Corporation | Welding method and arc welding device |
CN105436661A (zh) * | 2015-11-29 | 2016-03-30 | 上海新时达电气股份有限公司 | 摆弧焊接方法及弧焊机器人 |
CN106270946A (zh) * | 2016-09-19 | 2017-01-04 | 南昌大学 | 一种移动焊接机器人焊接矩形角焊缝的方法 |
CN108941845A (zh) * | 2018-08-28 | 2018-12-07 | 苏州艾利特机器人有限公司 | 一种弧焊机器人空间圆弧摆焊插补方法 |
CN109940623A (zh) * | 2018-10-26 | 2019-06-28 | 广东工业大学 | 一种应用于焊缝的机器人路径规划方法 |
Also Published As
Publication number | Publication date |
---|---|
CN110465949A (zh) | 2019-11-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110465949B (zh) | 焊接机器人及其摆动轨迹的规划方法 | |
CN110465948B (zh) | 焊接机器人及其摆动轨迹的规划方法 | |
JP6766186B2 (ja) | ロボット関節空間におけるポイントツーポイント移動の軌跡計画方法 | |
CN105500354A (zh) | 一种工业机器人应用的过渡轨迹规划方法 | |
US4590577A (en) | Welding robot controlling method | |
US4616326A (en) | Self optimizing robot controller | |
CN112008305B (zh) | 一种焊接机器人的摆焊轨迹规划方法 | |
CN108189034B (zh) | 一种机器人连续轨迹实现方法 | |
CN110465950B (zh) | 焊接机器人及其摆动轨迹的规划方法 | |
CN110450170B (zh) | 焊接机器人及其摆动轨迹的规划方法 | |
CN110450171B (zh) | 焊接机器人及其摆动轨迹的规划方法 | |
CN113650011B (zh) | 一种机械臂拼接路径规划方法及装置 | |
CN117655468A (zh) | 一种龙门架弧焊机器人路径规划方法及系统 | |
CN111702380A (zh) | 一种焊接机器人焊接过程控制方法 | |
CN113199475A (zh) | 一种适用于非标准圆弧的圆形摆弧路径的规划算法 | |
CN112171120A (zh) | 基于机器人焊缝特征节点的焊接技术 | |
CN107553485A (zh) | 一种人机交互过程中动态虚拟夹具的生成方法 | |
CN108717267B (zh) | 一种六足机器人中枢模式逆向控制方法 | |
Guo et al. | Trajectory tracking of unicycle-type robots with constraints | |
Han et al. | Dual Robot Coordinated Welding Trajectory Planning for Single Y-Groove Weld Seam of Plug-in Cross Pipe | |
JPH07114408A (ja) | ロボットの制御装置 | |
JPH04750B2 (zh) | ||
Wang et al. | Three-Dimensional Trajectory Planning for Multi-Robot Collaboration in Complex Components with Heterogeneous Materials | |
CN112621030A (zh) | 一种用于输电塔节点焊接轨迹生成方法 | |
CN116985139A (zh) | 一种快速调整机器人末端焊枪的路径算法系统 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |