Professional Documents
Culture Documents
改进B样条插值法的焊接机器人关节轨迹优化
改进B样条插值法的焊接机器人关节轨迹优化
改进 B 样条插值法的焊接机器人关节轨迹优化
方建文,
晁永生,
袁逸萍
(新疆大学机械工程学院,新疆 乌鲁木齐 830047)
摘 要:
为了提高汽车车身焊接过程中焊接机器臂轨迹的平稳性和精确度, 建立三次 B 样条曲
在B样条插值法为基础上,
线数学模型,
为使该曲线通过各焊点所对应的焊接机器臂关节空间位姿,
反算曲线控制顶点,
并对通过在控制顶点两侧
以提高机器人运动过程的平滑性。在 MATLAB 平台进行仿真实
添加辅助控制点的方法对机器人各关节进行轨迹优化,
验并与三次样条插值法进行对比,
优化结果表明,
各关节在焊点附近的速度、
加速度曲线变得更加平缓,
验证了该方法的
有效性。
关键词:焊接机器人;B 样条;轨迹优化;平滑性
中图分类号:TH16;P241.2 文献标识码:A 文章编号:1001-3997(2021)10-0001-04
DOI:10.19356/j.cnki.1001-3997.2021.10.001
Research on the Trajectory Optimization of Welding Robot Based on Improved
B-Spline Interpolation Method
FANG Jian-wen,CHAO Yong-sheng,YUAN Yi-ping
(Xinjiang University,Xinjiang Urumqi 830047,China)
Abstract:In order to improve the stability and accuracy of the trajectory of the welding robot,a mathematical model of cubic B-
spline curve is established on the basis of B-spline interpolation method.The control points of the curve are inversely calculated to
make sure that the curve pass through the corresponding joint position and posture of the welding robot.Then,the method of add⁃
ing auxiliary control points on both sides of the control points is used to optimize the trajectory of the robot.The trajectory optimiza⁃
tion is carried out to improve the smoothness of the robot motion process.The simulation experiments on MATLAB platform are car⁃
ried out and compared with the cubic spline interpolation method.The results show that the curves of velocity and acceleration of
the joints near the spot joints become smoother,
which verifies the effectiveness of the method.
Key Words:Welding Robot;B-Spline;Trajectory Optimization;Smoothness
1 引言 项式插值曲线进行分段拟合,
对关节速度进行了约束。文献[2]提
出了一种基于三次多项式插值法的加减速型 Nurbs 曲线前瞻算
白车身的焊接是汽车生产制造过程中不可缺少的一环,随
优化了轨迹的稳定性。文献[3]提出一种新型 S 型速度规划算
法,
着生产工艺的不断发展,
焊接过程中机器人的移动轨迹要求也越
来越高。目前工业生产中应用的焊接机器人大多是示教机器人, 法,
在一定程度平滑了加加速度曲线,
提升了运动过程中的抗冲
其反应能力往往较差,
而针对白车身焊点的焊接是一个快速起停 采用 S 型速度曲线进行轨迹
击性能。文献[4]针对加速度的突变,
的过程,
一旦出现不稳定因素干扰可能无法及时反应过来,
在一 规划,
提高了运动过程中的抗冲击性能。文献[5]针对工业机器人
定程度上影响了焊接的质量。因此,
根据实际的焊接任务,
在确 时间最优、
能耗最优、
脉动最优等多目标的轨迹优化问题,
基于非
线,
使临近焊点附近时焊接机器人各关节的位移、
速度、
加速度随 文献[6]构建七次 B 样条曲线,将机械人的运动学约束转化为 B 样
时间变化曲线更加平滑,
避免快速起停过程中出现机器臂共振等 条控制顶点的约束,实现了多目标轨迹优化。文献[7-8]以加加速
情况,
这对高质量高精度完成焊接任务,
提高白车身焊接生产线 度的平方以及 Jerk 的绝对值为优化目标,
其轨迹由于单一目标优
生产效率,
延长机器人的使用寿命具有重要意义。 化轨迹。文献[9]采用五次 B 样条插值法对轨迹进行拟合,
当约束
然而关于焊枪在进出焊点时局部运动的平稳性研究还比较匮乏。 轨迹的运动性能。
因此对机器人各关节空间采用改进的 B 样条插值法进行优化,
使 利用三次均匀 B 样条插值法,
已知, 通过4个控制点可以确
运动轨迹能够准确通过焊点,
并通过增加辅助控制点方法,
对焊 如图 1 所示。
定一段曲线,
点附近运动过程中的速度、加速度进行了优化,
使运动过程更加 图 1 中的三次均匀 B 样条曲线段由是由
依据德布尔递推法,
平稳。 Q 0、
Q 1、
Q 2、
Q 3 四个控制顶点确定,
该三次曲线的起点是 Q 0、
Q 1、
Q2
间,
由于焊接过程中焊点是固定且必须经过的,
因此将其作为末 中线 Q 2Q 2' 上的一点 N 2,Q 2N 2 的位长度是∆Q 1Q 2Q 3 中线 Q 2Q 2' 长
(θ 1 j ,θ 2 j ,…,θ 6 j )T(j = 1,2 ,…,n),其中,θ 1 j ,θ 2 j ,…,θ 6 j 表示机器人在 点时,那么 N 1 点则会不断靠近 Q 1' 点,同理,当 Q 2 点不断趋近于
∑QN
i
(4)可得改进后的三次 B 样条曲线方程为:
结合式(3)、
v ( t) = θ' ( t) = 'j j,4 ( t)
1 | é Q i,z ù
j=i-4
| -1 3 -3 (8)
| |ê ú
1
∑Q
i
| 3 -6 3 0 || êê Q i úú a ( t) = θ '' ( t) = ''
N j,3 ( t)
θ 3i + 1 ( t) = [ t3 t 2
t 1 ] || || êê ú
0 êê Q i,y úúú
j
6 | -3 0 3 j=i-3
| |ê
| 1 4 1 0 | ëQ i + 1,z úû 式(8)还要满足以下约束条件:
| -1 3 -3 1 | é Qi ù θ min ≤ | θ ( t) | ≤ θ max
| |ê ú
1 | 3 -6 3 0 || êê Q i,y úú ω min ≤ | v ( t) | ≤ ω max
θ 3i + 2 ( t) = [ t3 t2 t 1 ] || || êê ú (6) (9)
6 | -3 0 3 0 êêQ i + 1,z úúú
| |ê a min ≤ | A( t) | ≤ a max
| 1 4 1 0 | ë Q i + 1 úû
| -1 3 -3 1 | é Q i,y ù
4 仿真结果分析
| |ê ú
1 3 | 3 -6 3 0 || êê Q i + 1,z úú 以 Panasonic TA1800G2 型焊接机器人为研究对象,该机器
θ 3i + 3 ( t) = [t t2 t 1 ] || || êê ú
6 | -3 0 3 0 êê Q i + 1 úúú 人机构特点满足 Pieper 原则,
其 D - H 参数,
如表1所示。
| |ê
| 1 4 1 0 | ëQ i + 1,y úû
表 1 机器人运动参数和关节变量
i = 0,1,…,n - 1
其中, Tab.1 Motion Parameters and Joint Variables of
the Robot
由于所有的辅助控制点都可以由最初的控制点求得,故将
i / mm)
di( αi / rad)
(
-1 / mm)
a i( / rad)
θ i(
可得由 Q 0,
式(4)代入式(6), Q 1,
Q 2,
…,Q n 表示的改进三次 B 样条
1 0 0 0 θ1
曲线方程:
2 420 -π/2 155 θ2
| 1 5 2 1|
| - - | é Qi ù 3 0 0 650 θ3
|| 3 6 3 6 || êêQ úú
1 | | ê i + 1ú 4 0 -π/2 140
θ 3i + 1 ( t) = [ t3 t 2
t 1 ] ||| 0 0 0 0 ||| êê úú θ4
6 || | êQ ú
0 | êê i + 2 úú
| -1 0 1 5 920 π/2 0 θ5
| Q
| 0 6 0 0 | ë i + 3û 6 0 -π/2 60 θ6
| -1 3 -3 1 |
| | 根据表 1 中 D - H 参数使用如下指令,利用 MATLAB 中的
| 2 2 2 2 |
|
-5
|
1 | é Qi ù Robotics Toolbox 建立 Panasonic TA-1800G2 机械臂模型,示例代
|
1 3 | 1 2
2 - | êQ ú
2 | êê i + 1 úú 码如下:
θ 3i + 2 ( t) = [t t2 t 1 ] || ê ú (7)
6 | 0 -5 1 | êêQ úú L1=link(
[0 0 0 0 0]
| 3 - || êê i + 2 úú );
2 2 | ëQ i + 3 û
| L2=link(
[-pi/2 0.155 0 0.42 0]
);
| -2 31 5 -1 |
| | L3=link(
[0 0.65 -pi/2 0]
| 3 6 3 6 | );
| 1 -2 5 -1 | L4=link(
[-pi/2 0.14 0 0 0]
);
| |
| 6 3 6 3 | L5=link(
[pi/2 0 0 0.92 0]
);
| |é Q ù
| -1 2
-5 |
1 | êQ ú
i
L6=link(
[-pi/2 0.06 0 0 0]
);
1 | 2 2
θ 3i + 3 ( t) = [ t3 t 2
t 1 ] || | êê i + 1 úúú
ê
r=robot({L1 L2 L3 L4 L5 L6});
6 | êQ ú
| 1 -3
5 ê
0 || êê i + 2 úú
ú
| 2 2 r.name='TA-1800G2';
| | ëQ i + 3 û
| 1 1 31 -2 | plot(r,
[0 0 -pi/2 0 0 0]
);
|- |
| 6 6 6 3 | 示例代码中的 Link 指令中的各参数,
从左到右,
第一位表示
式(7)中的 i 不取 0 和 n - 1,
注: 因为始末两端点的新增辅助 扭转角 α,
第二位表示连杆长度 a,
第三位表示关节角 θ,
第四位表
点不按照上述方程求解,
但满足式(6),
可从此求解。 示连杆偏距 d, 由于是 6R 机器人,
最后一位表示关节角类型, 故都
3 约束条件 为 0, 如图 3 所示。
默认采用标准 D - H 法进行建模,
点焊机器人最优轨迹规划就是要求各个关节在满足运动学
约束条件的情况下,
确保焊接的准确性,
同时以较高的速度从焊
点移出,
并以较小的速度变化移至下一个焊点。所以说,
在实际
运动控制过程中,
机器人受到驱动机构性能等因素的制约,
具体
体现在角度约束、
角速度约束和角加速度约束这三方面。利用改
进三次 B 样条插值法进行轨迹规划,
通过对控制顶点的约束来实
现对机器人运动轨迹的约束。
图 3 Panasonic TA-1800G2 模型
假设机器人每个关节的角变化、速度、加速度约束分别为 Fig.3 Model of Panasonic TA-1800G2 Robot
2,
θ m、ω m、a m(m=1, 6)。可以求得各关节的位置、
…, 速度、
加速 在以机器人的基座为原点建立的空间坐标系中,在 (100 ×
(b)第 2 关节
图 4 焊点空间位置及焊接次序
Fig.4 Spacial Location and Welding Sequence of Welding Spot
机器人的末端执行器在移动过程中必经焊点的位置,将焊
点的位姿信息转化为机器人末端位姿,
通过运动学逆解得到每个
如表 2 所示。
焊接位姿对应的关节角, (c)第 3 关节
表 2 焊接位姿对应的关节角
Tab.2 Joint Angle Corresponding to the Welding Pose
焊点序号 θ1 θ2 θ3 θ4 θ5 θ6
1 1.759 -3.451 0.417 0.000 3.034 -1.759
2 1.801 -3.433 0.143 3.142 2.993 1.341
3 1.850 -3.393 -0.044 3.142 2.846 1.291
4 2.093 -3.379 0.664 0.000 2.715 -2.093
5 2.523 -3.451 0.420 0.000 3.031 -2.523 (d)第 4 关节
以表 2 中的数据作为型值点,
利用改进的三次 B 样条插值法,
在两侧添加辅助控制点,
对曲线进行拟合。为了能更直观的看出
各关节的轨迹规划效果, 结果如图 5
与三次样条插值法进行对比,
所示。通过对比可发现,
在满足焊接准确性的前提下,
部分关节
的速度、
加速度曲线均有波峰,
加速度曲线出现尖点,
通过改进三
次 B 样条插值后的关节速度波动范围以及关节加速度波动范围
(e)第 5 关节
较之三次样条插值法显著降低,
同时,
型值点附近的速度、
加速度
曲线变得更加平缓,
验证了机器人进入焊点位置和焊完离开焊点
位置时,
运动过程的稳定性,
减小了运动过程出现的冲击,
保证了
焊接的质量。
5 结论
针对焊接机器人中焊枪进出焊点时运动过程的平稳问题,
先求解出各个焊点对应的机器人各关节的空间位置,
然后以此为
控制顶点,通过添加辅助控制点的方法,对三次 B 样条插值法进 (f)第 6 关节
图 5 各关节位移、 速度、 加速度曲线( 为型值点)
行了改进,
生成平滑的运动。通过与三次样条插值法在不同时刻 Fig.5 Curves of Displacement,
Velocity and Acceleration for Each Joint
的位移、
速度、 验证了经过改进三次 B 样条插值法
加速度的对比, ( were recognized as the value points)
平滑后的轨迹保证了焊接的准确性,
同时运动过程的平稳性也得 参考文献
到显著提高。 [1]Wei Dong,Du Z,Xiao Y.Smooth and near time‐optimal trajectory plan‐
ning of industrial robots for online applications[J]. Industrial Robot,
2012,
39(2):
169-177(9).
[2]张力,
杨东升, 李海英 . 基于三次多项式加减速的 NURBS 插补
王允森,
前瞻控制算法[J].组合机床与自动化加工技术,
2014(3):
1-4.
(ZHANG Li,YANG Dong-sheng,WANG Yun-sen,LI Hai-ying.Look-
ahead Interpolation Algorithm for NURBS Curve Based on the Cubic
Polynomial Model[J].Modular Machine Tool & Automatic Manufactur‐
DOI:
10.7666/d.y746404. structured cranes[J].Chinese Journal of Construction Machinery,2009,
(Wang Yong-jun.Research on wind load and wind vibration of contain‐ 7(1):
7-12.)
(上接第 4 页)
孙会会 . 基于新 S 型速度规划的 B 样条曲线算法研究[J]. 机床
[3]史步海, [7]A.Piazzi.Global minimum- jerk trajectory planning of robot manipulators
2016,
与液压, 44(15):
72-79. [ J].IEEE Transactions on Industrial Electronics,2000 ,47(1):140
(SHI Bu-hai,SUN Hui-hui. B-spline Curve Algorithm Research - 149.
Based on New S Velocity Planning[J]. Machine Tool & Hydraulics, [8]Kyriakopoulos K.J.,Saridis G.N.Minimum jerk path generation[A].Pro‐
2016,
44(15):
72-79.) ceedings of the 1988 international conference on robotics and automa‐
[4]Javad Jahanpour,Mohammad Reza Alizadeh. A novel acc-jerk-limited tion[C],
Philadelphia,
1988:
364-369.
NURBS interpolation enhanced with an optimized S-shaped quintic [9]李小霞,
汪木兰, 蒋 荣 . 基于五次 B 样条的机械手关节空间平
刘 坤,
feedrate scheduling scheme[J]. The International Journal of Advanced 滑轨迹规划[J].组合机床与自动化加工技术,
2012(8):
39-42.
Manufacturing Technology,
2015,
77(9-12):
1889-1905. (Li Xiao-xia,WANG Mu-lan,LIU Kun,JIANG Rong.Smooth Trajecto‐
方红根 . 工业机器人时间-能量-脉动最优轨迹规划[J]. 机械
[5]施祥玲, ry Planning Based on Five Degrees B-spline for Manipulators in Joint
2018(4):
设计与制造, 228-234. Space[J]. Modular Machine Tool & Automatic Manufacturing Tech‐
(SHI Xiang-ling,FANG Hong-gen . Time-Energy-Jerk Optimal Plan‐ nique,
2012(8):
39-42.)
ning of Industrial Robot Trajectories[J].Machine Design and Manufac‐ [10]勾治践, 王成 . 基于 B 样条的 6R 机器人轨迹规划及仿真[J].
牛永康,
turing Engineering,
2018(4):
228-234.) 2013,
煤矿机械, 34(2):
48-50.
[6]Abe A .Minimum energy trajectory planning method for robot manipula‐ (GOU Zhi-jian,NIU Yong-kang,WANG Cheng. Trajectory Planning
tor mounted on flexible base[C]// Control Conference(ASCC),2013 and Simulation of 6R Robot Based on B-splines[J].Coal Mine Machin‐
9th Asian.IEEE,
2013. ery,
2013,
34(2):
48-50.)