APP下载

双臂机器人的轨迹规划研究与仿真1

2021-05-26刘子贵

中国科技产业 2021年5期

刘子贵

(江门职业技术学院 广东省江门市 529090)

0 引言

工业机器人能够代替人工完成枯燥、重复性较高的工作,大幅提高生产效率,甚至可以完成一些人工无法完成的危险性任务。虽然单臂机器人已经得到了广泛应用,但随着生产作业越来越复杂,单臂机器人在某些场合下已经无法胜任,例如较为复杂的搬运、柔性装配等应用,而双臂机器人则能完成这些工作任务。因此,研究双臂机器人的运动轨迹规划,可以提高机器人的双臂协作、协调能力,扩展其应用领域[1]。

1 轨迹规划方法

关节变量空间轨迹规划的常见方法有三次多项式插值和五阶多项式插值等方法。在关节变量空间中研究双臂机器人的轨迹规划,需要先根据机器人的逆运动学方程,算出机器人末端在运动轨迹上各个点的关节变量值,再利用这些关节变量值拟合出每个关节的运动轨迹。最后必须要保证运动轨迹、速度曲线、加速度曲线的连续性,以达到机器人运动平稳的目标[2]。

1.1 三次多项式插值法

设已知机器人的起点和终点位姿,根据机器人逆运动学方程,求出每个关节在初始时刻t0的关节值为θ0,终止时刻tf的关节值为θf。为了保证关节运动速度的平稳性,设定起点和终点的关节角速度为0,即:。根据这4个约束条件,可以确定该关节变量的三次多项式表达式,即:

对公式1求一阶和二阶导数,可以获取关节角速度和加速度:

设初始时刻t0=0,并将4个约束条件代入公式1和公式2可得:

登录APP查看全文