CN113305852B - 一种焊接机器人的摆焊轨迹规划方法 - Google Patents
一种焊接机器人的摆焊轨迹规划方法 Download PDFInfo
- Publication number
- CN113305852B CN113305852B CN202110787275.4A CN202110787275A CN113305852B CN 113305852 B CN113305852 B CN 113305852B CN 202110787275 A CN202110787275 A CN 202110787275A CN 113305852 B CN113305852 B CN 113305852B
- Authority
- CN
- China
- Prior art keywords
- swing
- time
- welding
- point
- equation
- 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
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/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
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B23—MACHINE TOOLS; METAL-WORKING NOT OTHERWISE PROVIDED FOR
- B23K—SOLDERING OR UNSOLDERING; WELDING; CLADDING OR PLATING BY SOLDERING OR WELDING; CUTTING BY APPLYING HEAT LOCALLY, e.g. FLAME CUTTING; WORKING BY LASER BEAM
- B23K37/00—Auxiliary devices or processes, not specially adapted to a procedure covered by only one of the preceding main groups
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
- Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
- Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Robotics (AREA)
- Physics & Mathematics (AREA)
- Optics & Photonics (AREA)
- Numerical Control (AREA)
Abstract
本发明涉及自动化焊接技术领域,具体是一种焊接机器人的摆焊轨迹规划方法,首先需要确定焊接参数,获得示教点位参数;然后确定摆动平面,在焊缝坐标系下,通过对整条轨迹的速度规划,得到插补所需的参数;再根据轨迹叠加的思想,在垂直于焊缝的方向采用摆线轨迹规划方法,沿着焊缝方向采用等时间的直线轨迹规划方法。本方法能够保证机器人在焊接过程中各关节角速度和角加速度连续,可有效提高焊缝质量。在垂直于焊接主轨迹的方向采用摆线位移分段函数,可保证速度、加速度在整个摆动焊接过程中连续。
Description
技术领域
本发明涉及自动化焊接技术领域,尤其涉及一种焊接机器人的摆焊轨迹规划方法。
背景技术
随着工业的发展,弧焊机器人的应用越来越广泛。在实际的焊接场景中,存在着宽焊缝焊接的问题。为此,要求焊接机器人除了具备直线焊接功能外,还应具有摆动焊接的功能。目前在进行摆焊轨迹规划时,摆动方向轨迹的位移函数普遍采用正余弦函数的表达式,但此种规划方式在焊接启停时存在速度和加速度阶跃的问题,对焊接的质量有很大的影响,摆焊的焊缝质量与摆焊轨迹有很大关系。
因此,现在急需一种新的技术方案来解决上述问题。
发明内容
本发明的目的在于克服上述现有技术的问题,提供了一种焊接机器人的摆焊轨迹规划方法,首先需要确定焊接参数,获得示教点位参数;然后确定摆动平面,在焊缝坐标系下,通过对整条轨迹的速度规划,得到插补所需的参数;再根据轨迹叠加的思想,在垂直于焊缝的方向采用摆线轨迹规划方法,沿着焊缝方向采用等时间的直线轨迹规划方法。本方法能够保证机器人在焊接过程中各关节角速度和角加速度连续,可有效提高焊缝质量在垂直于焊接主轨迹的方向采用摆线位移分段函数,可保证速度、加速度在整个摆动焊接过程中连续。
上述目的是通过以下技术方案来实现:
一种焊接机器人的摆焊轨迹规划方法,包括如下步骤:
S1通过示教的方法确定点位参数,并计算速度规划时所需的参数;所述点位参数包括焊缝起点坐标、焊缝终点坐标和摆点坐标;所述速度规划时所需的参数包括焊缝总长、总角位移和摆动参数;所述摆动参数包括单位摆动段摆动位移、摆动宽度、上摆点停留距离、中间摆点停留距离、下摆点停留距离;
S2根据步骤S1中所述焊缝起点坐标、所述焊缝终点坐标和所述摆点坐标确定摆动平面,并建立焊缝坐标系;
步骤S3:将步骤S1中所述焊缝总长和所述总角位移作为规划输入参数,采用7段S曲线规划,计算位置规划总时间、姿态规划总时间,进而确定插补总时间;
步骤S4:采用等摆长的方式进行轨迹规划,计算并获取摆动时间数组;
步骤S5:采用轨迹叠加思想,在沿着焊缝方向采用等时间的直线轨迹规划方法,垂直于焊缝的方向采用摆线轨迹规划方法,计算并获取摆焊插补点位。
进一步地,步骤S1中所述焊接参数包括焊缝的终点坐标Pend,摆点坐标Pweave,该焊接起点坐标Pstart、摆动参数。
进一步地,步骤S1中所述焊缝总长S的计算如式(1):
所述总角位移θ的计算如式(2):
其中,R表示初末位置之间的旋转矩阵,为3×3的矩阵。
进一步地,步骤S2中所述焊缝坐标系的计算如式(3)—(6):
其中,起点Pstart为焊缝起点坐标、终点Pend为焊缝终点坐标、摆点Pweave为摆点坐标,为由起点指向摆点的向量,/>为摆平面法向量。
进一步地,步骤S3中所述位置规划总时间、所述姿态规划总时间和所述插补总时间的计算如下:
设定各个阶段的过渡点时刻为tk(k=1,…7),Tk=tk-tk-1(k=1,…7)表示各个阶段的持续运行时间,则各阶段持续运行时间可由式(7)(8)(9)(10)计算得到:
其中,A、D为加速度,J为加加速度,vs表示起始速度,ve表示终止速度,vc表示指令速度,由用户自行设定。
则总时间如式(11):
t7=T1+T2+T3+T4+T5+T6+T7 (11)
替换式(9)中的TL,当TL=S时可计算得到位置规划总时间Tpos,当TL=θ时可计算得到姿态规划总时间Tort,插补总时间T的计算如式(12):
其中,S为焊缝总长、θ为总角位移。
进一步地,所述步骤S4具体为:
先计算摆动的段数n,如式(13):
其中,S为焊缝总长度,L为单位摆动段动位移;
假设当n=7时,即包含7个完整摆动段,1个摆动段即为1个单位周期摆动位移则:
当0<St<S1,St=1*L其所对应的时间段为[0,t1],t1为第一个摆动段终止时间,可由式(14)计算得到,其中St为当前段的位移,J为加加速度,式(14)如下:
当S1≤St<S2时,t2为第二个摆动段终止时间,t2为二元一次方程ax2+bx+c=0的正根,其中a=A,b=-(2*A*t1-2*V1),其中V1表示t1处的速度值,可由式(15)计算得到,式(15)如下:
当S2≤St<S3时,t3为第三个摆动段终止时间,t3为三元一次方程ax3+bx2+cx+d=0的正根,其中a=J,b=-3*A,c=-6*V2,d=-6*S2+6*St,其中V2表示t2处的速度值,可由式(16)计算得到,式(16)如下:
V2=V1+At2 (16)
当S3≤St<S4时,t4为第四个摆动段终止时间,其中V3表示t3处的速度值,可由式(17)计算得到,式(17)如下:
当S4≤St<S5时,t5为第五个摆动段终止时间,t5=t+t4,t为三元一次方程ax3+bx2+cx+d=0的正根,其中a=J,b=0,c=-6*V4,d=-6*S4+6*St,其中V4表示t4处的速度值,可由式(18)计算得到,式(18)如下:
V4=V3 (18)
当S5≤St<S6时,t6为第六个摆动段终止时间,t6=t+t5为二元一次方程ax2+bx+c=0的正根,其中a=0.5*A,b=-V5,c=St-S5,其中V5表示t5处的速度值,可由式(19)计算得到,式(19)如下:
当S6≤St<S7时,t7为第七个摆动段终止时间。t7=t+t6为二元一次方程ax2+bx+c=0的正根,其中a=J,b=-3*A,c=6*V6,d=6*S6-6*St,其中V6表示t6处的速度值,可由式(20)计算得到,式(20)如下:
V6=V5-At6 (20)
根据当前段的位移对应7段曲线中的位移,可计算出当前段所对应的时间段,则
Tweave=[0,t1,t2,t3,t4,t5,t6,t7]。
进一步地,所述步骤S5具体为:
在进行轨迹插补时,每个时刻t对应的插补点的坐标由沿着焊接方向的位移和垂直于焊缝方向的摆动位移叠加得到,如式(21):
Sp(t)=(x,y)=Sx(t)+Sy(t) (21)
其中,Sp为焊缝坐标系下的坐标,Sp(t)为焊缝坐标系下每个时刻的坐标,Sy为焊缝坐标系下的纵坐标,Sy(t)为焊缝坐标系下每个时刻的纵坐标,Sx为焊缝坐标系下的横坐标,Sx(t)为焊缝坐标系下每个时刻的横坐标,焊缝坐标系下每个时刻的横坐标Sx(t)的计算如式(22):
Sx(t)=Pstartx+t*(Pendx-Pstartx),t∈[0,1] (22)
其中,pstartx为起点在焊缝坐标系下的横坐标,pendx为终点在焊缝坐标系下的横坐标。
一个完整摆动段由8段轨迹组成,其中包含一段上摆点停留距离Lt,两段中间摆点停留距离Lm和一段下摆点停留距离Lb和四段轨迹曲线,如附图1所示。
插补中过渡时刻的计算过程如下:
tsin=te-ts (23)
其中tsin表示当前摆动段所需的总时间,ts表示当前摆动段的开始时间,te表示当前摆动段的终止时间,ttop表示上摆点停留距离所需的时间,tmid表示中间摆点停留距离所需的时间,tbot表示下摆点停留距离所需的时间。四段轨迹曲线所需时间tel可由式求得
tsi表示摆动段中各段过渡点的时刻,则:
ts1=ts+tel (28)
ts2=ts1+ttop (29)
ts3=ts2+tel (30)
ts4=ts3+tmid (31)
ts5=ts4+tel (32)
ts6=ts5+tbot (33)
ts7=ts6+tel (34)
ts8=tS7+tmid (35)
则焊缝坐标系下每个时刻的纵坐标Sy(t)的计算如式(36):
其中,Am表示摆动运动的振幅,大小为摆动宽度的一半,ct为完成每个单位摆动段动移的时间。
有益效果
本发明所提供的一种焊接机器人的摆焊轨迹规划方法,首先需要确定焊接参数,获得示教点位参数;然后确定摆动平面,在焊缝坐标系下,通过对整条轨迹的速度规划,得到插补所需的参数;再根据轨迹叠加的思想,在垂直于焊缝的方向采用摆线轨迹规划方法,沿着焊缝方向采用等时间的直线轨迹规划方法。本方法能够保证机器人在焊接过程中各关节角速度和角加速度连续,可有效提高焊缝质量在垂直于焊接主轨迹的方向采用摆线位移分段函数,可保证速度、加速度在整个摆动焊接过程中连续。
附图说明
图1为本发明所述一种焊接机器人的摆焊轨迹规划方法的单个摆动周期轨迹示意图;
图2为本发明所述一种焊接机器人的摆焊轨迹规划方法的各个关节位置;
图3为本发明所述一种焊接机器人的摆焊轨迹规划方法的各个关节角速度;
图4为本发明所述一种焊接机器人的摆焊轨迹规划方法的各个关节角加速度;
图5为本发明所述一种焊接机器人的摆焊轨迹规划方法的焊接过程轨迹示意图;
图6为本发明所述一种焊接机器人的摆焊轨迹规划方法的7段S曲线规划位移曲线。
具体实施方式
下面根据附图和实施例对本发明作进一步详细说明。所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其它实施例,都属于本发明保护的范围。
本方法首先需要确定焊接参数,获得示教点位参数;然后确定摆动平面,在焊缝坐标系下,通过对整条轨迹的速度规划,得到插补所需的参数;再根据轨迹叠加的思想,在垂直于焊缝的方向采用摆线轨迹规划方法,沿着焊缝方向采用等时间的直线轨迹规划方法。方案具体如下:
一种焊接机器人的摆焊轨迹规划方法,包括如下步骤:
S1通过示教的方法确定点位参数,并计算速度规划时所需的参数;所述点位参数包括焊缝起点坐标、焊缝终点坐标和摆点坐标;所述速度规划时所需的参数包括焊缝总长、总角位移和摆动参数;所述摆动参数包括单位摆动段摆动位移、摆动宽度、上摆点停留距离、中间摆点停留距离、下摆点停留距离;
S2根据步骤S1中所述焊缝起点坐标、所述焊缝终点坐标和所述摆点坐标确定摆动平面,并建立焊缝坐标系;
步骤S3:将步骤S1中所述焊缝总长和所述总角位移作为规划输入参数,采用7段S曲线规划,计算位置规划总时间、姿态规划总时间,进而确定插补总时间;
步骤S4:采用等摆长的方式进行轨迹规划,计算并获取摆动时间数组;
步骤S5:采用轨迹叠加思想,在沿着焊缝方向采用等时间的直线轨迹规划方法,垂直于焊缝的方向采用摆线轨迹规划方法,计算并获取摆焊插补点位。
作为本实施例中步骤S1的优化,步骤S1中所述焊接参数包括焊缝的终点坐标Pend,摆点坐标Pweave,该焊接起点坐标Pstart、摆动参数等。
首先通过示教的方法来确定焊缝终点Pend(xe,ye,ze,Rz,Ry,Rx),上摆点Pweave(xw,yw,zw,Rz,Ry,Rx)。起点、终点、摆点需保证3点不共线。起点坐标Pstart(xs,ys,zs,Rz,Ry,Rx)。
摆动参数(单位摆动段动位移L、摆动宽度A、上摆点停留距离Lt、中间摆点停留距离Lm、下摆点停留距离Lb,一个完整摆动周期的轨迹如附图1所示)由用户根据不同的焊缝和工艺要求来设置参数。
所述焊缝总长S的计算如式(1):
所述总角位移θ的计算如式(2):
其中,R表示初末位置之间的旋转矩阵,为3×3的矩阵。
作为本实施例中步骤S2的优化,根据起点Pstart、终点Pend、摆点Pweave,唯一确定摆动平面,以焊接起点为原点,焊缝方向为x轴,可由式计算(3)得到,摆平面法向量为z轴,可通过式(4)和(5)计算得到,其中/>为由起点指向摆点的向量,可通过式(6)计算得到y轴:
其中,起点Pstart为焊缝起点坐标、终点Pend为焊缝终点坐标、摆点Pweave为摆点坐标,为由起点指向摆点的向量,/>为摆平面法向量。
作为本实施例中步骤S3的优化,根据步骤(1)中计算得到的焊缝总长度S、总的角位移θ作为规划输入参数,采用7段S曲线规划,位移曲线如图6所示。步骤S3中所述位置规划总时间、所述姿态规划总时间和所述插补总时间的计算如下:
设定各个阶段的过渡点时刻为tk(k=1,…7),Tk=tk-tk-1(k=1,…7)表示各个阶段的持续运行时间,则各阶段持续运行时间可由式(7)(8)(9)(10)计算得到:
其中,A、D为加速度,J为加加速度,vs表示起始速度,ve表示终止速度,vc表示指令速度,由用户自行设定。
则总时间t7如式(11):
t7=T1+T2+T3+T4+T5+T6+T7 (11)
替换式(9)中的TL,当TL=S时可计算得到位置规划总时间Tpos,当TL=θ时可计算得到姿态规划总时间Tort,插补总时间T的计算如式(12):
其中,S为焊缝总长、θ为总角位移。
作为本实施例中步骤S4的优化,进行轨迹规划时采用等摆长的方式进行规划,在进行插补计算前需要知道每个摆动长度对应的起止时间存入Tweave数组中;摆动的段数n可以式(13)计算得到。先计算摆动的段数n,如式(13):
其中,S为焊缝总长度,L为单位摆动段动位移;
假设当n=7时,即包含7个完整摆动段,1个摆动段即为1个单位周期摆动位移则:
当0<St<S1,St=1*L其所对应的时间段为[0,t1],t1为第一个摆动段终止时间,可由式(14)计算得到,其中St为当前段的位移,J为加加速度,式(14)如下:
当S1≤St<S2时,t2为第二个摆动段终止时间,t2为二元一次方程ax2+bx+c=0的正根,其中a=A,b=-(2*A*t1-2*V1),其中V1表示t1处的速度值,可由式(15)计算得到,式(15)如下:
当S2≤St<S3时,t3为第三个摆动段终止时间,t3为三元一次方程ax3+bx2+cx+d=0的正根,其中a=J,b=-3*A,c=-6*V2,d=-6*S2+6*St,其中V2表示t2处的速度值,可由式(16)计算得到,式(16)如下:
V2=V1+At2 (16)
当S3≤St<S4时,t4为第四个摆动段终止时间,其中V3表示t3处的速度值,可由式(17)计算得到,式(17)如下:
当S4≤St<S5时,t5为第五个摆动段终止时间,t5=t+t4,t为三元一次方程ax3+bx2+cx+d=0的正根,其中a=J,b=0,c=-6*V4,d=-6*S4+6*St,其中V4表示t4处的速度值,可由式(18)计算得到,式(18)如下:
V4=V3 (18)
当S5≤St<S6时,t6为第六个摆动段终止时间,t6=t+t5为二元一次方程ax2+bx+c=0的正根,其中a=0.5*A,b=-y5,c=St-S5,其中V5表示t5处的速度值,可由式(19)计算得到,式(19)如下:
当S6≤St<S7时,t7为第七个摆动段终止时间。t7=t+t6为二元一次方程ax2+bx+c=0的正根,其中a=J,b=-3*A,c=6*V6,d=6*S6-6*St,其中V6表示t6处的速度值,可由式(20)计算得到,式(20)如下:
V6=V5-At6 (20)
根据当前段的位移对应7段曲线中的位移,可计算出当前段所对应的时间段,则
Tweave=[0,t1,t2,t3,t4,t5,t6,t7]。
作为本实施例中步骤S5的优化,在进行轨迹插补时,每个时刻t对应的插补点的位移由沿着焊接方向的位移和垂直于焊缝方向的摆动位移叠加得到,如式(21):
Sp(t)=(x,y)=Sx(t)+Sy(t) (21)
其中,Sp为焊缝坐标系下的坐标,Sp(t)为焊缝坐标系下每个时刻的坐标,Sy为焊缝坐标系下的纵坐标,Sy(t)为焊缝坐标系下每个时刻的纵坐标,Sx为焊缝坐标系下的横坐标,Sx(t)为焊缝坐标系下每个时刻的横坐标,焊缝坐标系下每个时刻的横坐标Sx(t)的计算如式(22):
Sx(t)=Pstartx+t*(Pendx-Pstartx),t∈[0,1] (22)
其中,pstartx为起点在焊缝坐标系下的横坐标,pendx为终点在焊缝坐标系下的横坐标,
一个完整摆动段由8段轨迹组成,其中包含一段上摆点停留距离Lt,两段中间摆点停留距离Lm和一段下摆点停留距离Lb和四段轨迹曲线,如附图1所示。
插补中过渡时刻的计算过程如下:
tsin=te-ts (23)
其中tsin表示当前摆动段所需的总时间,ts表示当前摆动段的开始时间,te表示当前摆动段的终止时间,ttop表示上摆点停留距离所需的时间,tmid表示中间摆点停留距离所需的时间,tbot表示下摆点停留距离所需的时间。四段轨迹曲线所需时间tel可由式求得
tsi表示摆动段中各段过渡点的时刻,则
ts1=ts+tel (28)
ts2=ts1+ttop (29)
ts3=ts2+tel (30)
ts4=ts3+tmid (31)
ts5=ts4+tel (32)
ts6=ts5+tbot (33)
ts7=ts6+tel (34)
ts8=ts7+rtmid (35)
则焊缝坐标系下每个时刻的纵坐标Sy(t)的计算如式(36):
其中,Am表示摆动运动的振幅,大小为摆动宽度的一半,ct为完成每个单位摆动段动移的时间。
整个焊接过程中6个关节的位置、角速度、角加速度平稳,分别如附图2、3、4和5所示。
以上所述仅为说明本发明的实施方式,并不用于限制本发明,对于本领域的技术人员来说,凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (5)
1.一种焊接机器人的摆焊轨迹规划方法,其特征在于,包括:
S1通过示教的方法确定点位参数,并计算速度规划时所需的参数;所述点位参数包括焊缝起点坐标、焊缝终点坐标和摆点坐标;所述速度规划时所需的参数包括焊缝总长、总角位移和摆动参数;所述摆动参数包括单位摆动段摆动位移、摆动宽度、上摆点停留距离、中间摆点停留距离、下摆点停留距离;
S2根据步骤S1中所述焊缝起点坐标、所述焊缝终点坐标和所述摆点坐标确定摆动平面,并建立焊缝坐标系;
S3将步骤S1中所述焊缝总长和所述总角位移作为规划输入参数,采用7段S曲线规划,计算位置规划总时间、姿态规划总时间,进而确定插补总时间;
S4采用等摆长的方式进行轨迹规划,计算并获取摆动时间数组;
S5采用轨迹叠加思想,在沿着焊缝方向采用等时间的直线轨迹规划方法,垂直于焊缝的方向采用摆线轨迹规划方法,计算并获取摆焊插补点位;
所述步骤S4具体为:
先计算摆动的段数n,如式(13):
其中,S为焊缝总长度,L为单位摆动段动位移;
假设当n=7时,即包含7个完整摆动段,1个摆动段即1个单位摆动段动位移,则:
当0<St<S1,St=1*L其所对应的时间段为[0,t1],t1为第一个摆动段终止时间,可由式(14)计算得到,其中St为当前段的位移,J为加加速度,式(14)如下:
当S1≤St<S2时,t2为第二个摆动段终止时间,t2为二元一次方程ax2+bx+c=0的正根,其中a=A,b=-(2*A*t1-2*V1),其中V1表示t1处的速度值,可由式(15)计算得到,式(15)如下:
当S2≤St<S3时,t3为第三个摆动段终止时间,t3为三元一次方程ax3+bx2+cx+d=0的正根,其中a=J,b=-3*A,c=-6*V2,d=-6*S2+6*St,其中V2表示t2处的速度值,可由式(16)计算得到,式(16)如下:
V2=V1+At2 (16)
当S3≤St<S4时,t4为第四个摆动段终止时间,其中V3表示t3处的速度值,可由式(17)计算得到,式(17)如下:
当s4≤St<S5时,t5为第五个摆动段终止时间,t5=t+t4,t为三元一次方程ax3+bx2+cx+d=0的正根,其中a=J,b=0,c=-6*V4,d=-6*S4+6*St,其中V4表示t4处的速度值,可由式(18)计算得到,式(18)如下:
V4=V3 (18)
当S5≤St<S6时,t6为第六个摆动段终止时间,t6=t+t5为二元一次方程ax2+bx+c=0的正根,其中a=0.5*A,b=-V5,c=St-S5,其中V5表示t5处的速度值,可由式(19)计算得到,式(19)如下:
当S6≤St<S7时,t7为第七个摆动段终止时间,t7=t+t6为二元一次方程ax2+bx+c=0的正根,其中a=J,b=-3*A,c=6*V6,d=6*S6-6*St,其中V6表示t6处的速度值,可由式(20)计算得到,式(20)如下:
V6=V5-At6 (20)
根据当前段的位移对应7段曲线中的位移,可计算出当前段所对应的时间段,则
Tweave=[0,t1,t2,t3,t4,t5,t6,t7]。
2.根据权利要求1所述的一种焊接机器人的摆焊轨迹规划方法,其特征在于,步骤S1中所述焊缝总长S的计算如式(1):
所述总角位移θ的计算如式(2):
其中,R表示初末位置之间的旋转矩阵,为3×3的矩阵。
3.根据权利要求1所述的一种焊接机器人的摆焊轨迹规划方法,其特征在于,步骤S2中所述焊缝坐标系的计算如式(3)-(6):
其中,起点Pstart为焊缝起点坐标、终点Pend为焊缝终点坐标、摆点Pweave为摆点坐标,为由起点指向摆点的向量,/>为摆平面法向量。
4.根据权利要求1所述的一种焊接机器人的摆焊轨迹规划方法,其特征在于,步骤S3中所述位置规划总时间、所述姿态规划总时间和所述插补总时间的计算如下:
设定各个阶段的过渡点时刻为tk(k=1,...7),Tk=tk-tk-1(k=1,...7)表示各个阶段的持续运行时间,则各阶段持续运行时间可由式(7)(8)(9)(10)计算得到:
其中,A、D为加速度,J为加加速度,vs表示起始速度,ve表示终止速度,vc表示指令速度,由用户自行设定;
则总时间如式(11):
t7=T1+T2+T3+T4+T5+T6+T7 (11)
替换式(9)中的TL,当TL=S时可计算得到位置规划总时间Tpos,当TL=θ时可计算得到姿态规划总时间Tort,插补总时间T的计算如式(12):
其中,S为焊缝总长、θ为总角位移。
5.根据权利要求1所述的一种焊接机器人的摆焊轨迹规划方法,其特征在于,所述步骤S5具体为:
在进行轨迹插补时,每个时刻t对应的插补点的坐标由沿着焊接方向的位移和垂直于焊缝方向的摆动位移叠加得到,如式(21):
Sp(t)=(x,y)=Sx(t)+Sy(t) (21)
其中,Sp为焊缝坐标系下的坐标,Sp(t)为焊缝坐标系下每个时刻的坐标,Sy为焊缝坐标系下的纵坐标,Sy(t)为焊缝坐标系下每个时刻的纵坐标,Sx为焊缝坐标系下的横坐标,Sx(t)为焊缝坐标系下每个时刻的横坐标,焊缝坐标系下每个时刻的横坐标Sx(t)的计算如式(22):
Sx(t)=Pstartx+t*(Pendx-Pstartx),t∈[0,1] (22)
其中,pstartx为起点在焊缝坐标系下的横坐标,pendx为终点在焊缝坐标系下的横坐标;
一个完整摆动段由8段轨迹组成,其中包含一段上摆点停留距离Lt,两段中间摆点停留距离Lm和一段下摆点停留距离Lb和四段轨迹曲线;
插补中过渡时刻的计算过程如下:
tsin=te-ts (23)
其中tsin表示当前摆动段所需的总时间,ts表示当前摆动段的开始时间,te表示当前摆动段的终止时间,ttop表示上摆点停留距离所需的时间,tmid表示中间摆点停留距离所需的时间,tbot表示下摆点停留距离所需的时间,四段轨迹曲线所需平均时间tel可由式求得:
tsi表示摆动段中各段过渡点的时刻,则
ts1=ts+tel (28)
ts2=ts1+ttop (29)
ts3=ts2+tel (30)
ts4=ts3+tmid (31)
ts5=ts4+tel (32)
ts6=ts5+tbot (33)
ts7=ts6+tel (34)
ts8=ts7+tmid (35)
则焊缝坐标系下每个时刻的纵坐标Sy(t)的计算如式(36):
其中,Am表示摆动运动的振幅,大小为摆动宽度的一半,ct为完成每个单位摆动段动移的时间。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110787275.4A CN113305852B (zh) | 2021-07-12 | 2021-07-12 | 一种焊接机器人的摆焊轨迹规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110787275.4A CN113305852B (zh) | 2021-07-12 | 2021-07-12 | 一种焊接机器人的摆焊轨迹规划方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113305852A CN113305852A (zh) | 2021-08-27 |
CN113305852B true CN113305852B (zh) | 2023-08-25 |
Family
ID=77382137
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110787275.4A Active CN113305852B (zh) | 2021-07-12 | 2021-07-12 | 一种焊接机器人的摆焊轨迹规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113305852B (zh) |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH11276980A (ja) * | 1998-03-31 | 1999-10-12 | Hitachi Zosen Corp | 塗装ロボットにおける塗装膜厚の制御方法およびロボット軌道生成方法 |
KR20060012385A (ko) * | 2004-08-03 | 2006-02-08 | 현대중공업 주식회사 | 로봇의 연속 용접선 추종 제어 시스템 및 그 제어방법 |
CN110465765A (zh) * | 2019-08-19 | 2019-11-19 | 南京埃斯顿机器人工程有限公司 | 一种焊接机器人正弦摆焊的启停抖动削弱方法 |
CN110465948A (zh) * | 2019-09-09 | 2019-11-19 | 北京配天技术有限公司 | 焊接机器人及其摆动轨迹的规划方法 |
CN112008305A (zh) * | 2020-09-02 | 2020-12-01 | 南京埃斯顿自动化股份有限公司 | 一种焊接机器人的摆焊轨迹规划方法 |
-
2021
- 2021-07-12 CN CN202110787275.4A patent/CN113305852B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH11276980A (ja) * | 1998-03-31 | 1999-10-12 | Hitachi Zosen Corp | 塗装ロボットにおける塗装膜厚の制御方法およびロボット軌道生成方法 |
KR20060012385A (ko) * | 2004-08-03 | 2006-02-08 | 현대중공업 주식회사 | 로봇의 연속 용접선 추종 제어 시스템 및 그 제어방법 |
CN110465765A (zh) * | 2019-08-19 | 2019-11-19 | 南京埃斯顿机器人工程有限公司 | 一种焊接机器人正弦摆焊的启停抖动削弱方法 |
CN110465948A (zh) * | 2019-09-09 | 2019-11-19 | 北京配天技术有限公司 | 焊接机器人及其摆动轨迹的规划方法 |
CN112008305A (zh) * | 2020-09-02 | 2020-12-01 | 南京埃斯顿自动化股份有限公司 | 一种焊接机器人的摆焊轨迹规划方法 |
Also Published As
Publication number | Publication date |
---|---|
CN113305852A (zh) | 2021-08-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106392267B (zh) | 一种六自由度焊接机器人线激光实时焊缝跟踪方法 | |
CN107363813B (zh) | 一种基于可穿戴设备的桌面工业机器人示教系统和方法 | |
CN109623825B (zh) | 一种移动轨迹规划方法、装置、设备和存储介质 | |
CN106346129B (zh) | 一种基于激光焊缝跟踪传感器的机器人焊接运动控制方法 | |
CN102762331A (zh) | 焊接装置以及焊接方法 | |
CN105856231B (zh) | 一种特定构型六轴工业机器人的运动控制方法 | |
CN103418950A (zh) | 工业焊接机器人焊缝跟踪过程位姿自动调整方法 | |
CN112008305B (zh) | 一种焊接机器人的摆焊轨迹规划方法 | |
CN113334385A (zh) | 一种自驱动关节臂测量机直线轨迹间平滑过渡的规划方法 | |
CN111531536A (zh) | 机器人控制方法、机器人、电子设备和可读存储介质 | |
CN109773376A (zh) | 一种焊接机器人的正弦摆焊方法 | |
CN103706518B (zh) | 一种点胶方法、装置及系统 | |
CN108189034A (zh) | 一种机器人连续轨迹实现方法 | |
CN114378830B (zh) | 一种机器人腕关节奇异规避方法及系统 | |
CN113305852B (zh) | 一种焊接机器人的摆焊轨迹规划方法 | |
CN112650217B (zh) | 一种基于评估函数的机器人轨迹跟踪策略动态优化方法 | |
CN115213898A (zh) | 一种基于逆解多目标优化的焊接机器人笛卡尔空间轨迹规划方法 | |
CN113199475B (zh) | 一种适用于非标准圆弧的圆形摆弧路径的规划算法 | |
CN112757301A (zh) | 机器人抗扰动控制方法、装置、电子设备及存储介质 | |
CN112356032A (zh) | 一种姿态平滑过渡方法及系统 | |
CN116494250A (zh) | 基于速度补偿的机械臂控制方法、控制器、介质及系统 | |
CN105436661B (zh) | 摆弧焊接方法及弧焊机器人 | |
CN113199476A (zh) | 可快速调整焊枪姿态的圆弧8字形摆弧路径的规划算法 | |
JP2020019125A (ja) | ロボット制御方法 | |
JPH08257955A (ja) | マニピュレーターの曲面なぞり制御方法 |
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 |