Patent ID: 8543239
Filing Date: 2013-09-24
Classification: B25J,G05B

Abstract:
1. A robot control apparatus controlling a robot having a joint, comprising: an actuator configured to drive the joint for each control cycle; a detection unit configured to detect a joint angle of the joint for the each control cycle; a position calculation unit configured to calculate a tip end position of the robot from the joint angle for the each control cycle; a first value calculation unit configured to calculate a position command value for controlling the tip end position for the each control cycle; an error calculation unit configured to calculate an error between the tip end position and the position command value for the each control cycle; a difference calculation unit configured to calculate a joint angle difference from the error by inverse kinematic calculation for the each control cycle; an second value calculation unit configured to calculate a joint angle command value by integrating the joint angle difference for the each control cycle; a drive unit configured to drive the actuator based on the joint angle command value for the each control cycle; a first velocity estimation unit configured to calculate a plurality of first joint angular accelerations in already executed control cycles by calculating the joint angular acceleration from the joint angle for the each control cycle, and configured to estimate a joint angular velocity in a still unexecuted control cycle from the first joint angular accelerations; a maximum velocity memory configured to store a maximum velocity for the estimated joint angular velocity; a velocity determination unit configured to determine whether the estimated joint angular velocity exceeds the maximum velocity; and a suppression velocity calculation unit configured to calculate a suppression joint angular velocity in the still unexecuted control cycle from the estimated joint angular velocity when the estimated joint angular velocity is determined to exceed the maximum velocity, wherein the first velocity estimation unit comprises: a velocity calculation unit configured to calculate the joint angular velocity from the joint angle for the each control cycle; a first acceleration calculation unit configured to calculate the first joint angular accelerations by calculating the joint angular acceleration from the calculated joint angular velocity for the each control cycle; a second acceleration calculation unit configured to calculate a second joint angular acceleration in a current control cycle from the joint angle difference; an acceleration estimation unit configured to estimate a third joint angular acceleration in the still unexecuted control cycle from the first and second joint angular accelerations; and a second velocity estimation unit configured to estimate the joint angular velocity in the still unexecuted control cycle from the third joint angular acceleration.