多关节型机器人的控制装置、控制方法以及控制程序
摘要:
本发明提供多关节型机器人的控制装置及方法,旨在维持多关节型机器人的作业部的位置以及移动速度的同时使第1关节驱动系统的驱动轴各自的角度可靠地到达作业结束点的角度。在例外条件未满足的情况下,基于步骤(S5)中所计算的插补点来驱动第1以及第2关节驱动系统的驱动轴的每一个轴(S64)。在例外条件满足后(S61的“是”侧),至作业部到达作业结束点为止的期间(S12的“否”侧),计算用于以作业结束点的角度为目标使第1关节驱动系统的驱动轴各自线性地变化的该第1关节驱动系统的驱动轴各自的角度(S8),并基于该计算出的第1关节驱动系统的驱动轴各自的角度和步骤(S5)中计算出的插补点处的作业部的位置来计算第2关节驱动系统的驱动轴各自的角度(S9),且遵照该计算结果来使第1以及第2关节驱动系统的驱动轴进行驱动(S11)。
0/0