Robot control apparatus
AssigneeKabushiki Kaisha Toshiba
InventorsJunichiro Oga, Junji Oaki, Hideki Ogawa
Life of this patent
Estimating the term…
Abstract
A robot control apparatus includes: a joint angular velocity estimation unit (115) calculating a plurality of first joint angular accelerations in already executed control cycles by calculating a joint angular acceleration from a joint angle for each control cycle, and estimating a joint angular velocity in a still unexecuted control cycle from the first joint angular accelerations; a velocity determination unit (113) determining whether the estimated joint angular velocity exceeds a maximum velocity; and a suppression velocity calculation unit (114) calculating a suppression joint angular velocity in the still unexecuted control cycle from the estimated joint angular velocity.
Claims5
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.
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 first difference calculation unit configured to calculate a first 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 first 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 second joint angle difference in a still unexecuted control cycle by calculating the joint angle difference from the position command value sequentially, and configured to estimate a joint angular velocity in a still unexecuted control cycle from the second joint angle difference;
- 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.
Dependencies are inferred from the claim text.