Back to results
US 2011/0087374 A1Published application
Robot system
AssigneeKabushiki Kaisha Yaskawa Denki
InventorsShingo ANDO, Yasuyuki INOUE
Life of this patent
Estimating the term…
Abstract
First calculation means calculates a TCP velocity error vector Verr when wrist axes performs rotational following movement, second calculation means selects a component, including the sign, of the TCP velocity error vector Verr, third calculation means decomposes the selected velocity error vector into a joint velocity vector ωerr, fourth calculation means integrates the joint velocity ωerr and calculates a position correction amount vector θadd, and the position correction amount vector θadd is fed back to position control means with torque limits.
Claims5
A robot system comprising:
- a robot including at least main axes and wrist axes;
- first calculation means for calculating a first velocity error vector of a tip of a tool of the robot, the first velocity error vector being generated as a result of the robot following an external force applied to the tool disposed at an end of the robot;
- second calculation means for outputting a second velocity error vector, the second velocity error vector including a vector component of the first velocity error vector that has been calculated, the vector component being related to translational movement;
- third calculation means for decomposing the second velocity error vector that has been output into a joint velocity vector of the main axes;
- fourth calculation means for calculating a position correction amount vector by integrating the joint velocity vector that has been decomposed;
- and
- position control means for controlling positions of drive motors of the robot on the basis of a position command to which the position correction amount vector has been added.
4 more elements
A robot system comprising:
- a robot including at least main axes and wrist axes;
- first calculation means for calculating a first velocity error vector of a tip of a tool of the robot, the first velocity error vector being generated as a result of the robot following an external force applied to the tool disposed at an end of the robot;
- second calculation means for outputting a second velocity error vector, the second velocity error vector being obtained by selecting a vector component related to rotational movement in the first velocity error vector that has been calculated and by making a magnitude of the selected component zero;
- third calculation means for decomposing the second velocity error vector that has been output into a joint velocity vector of the main axes and the wrist axes;
- fourth calculation means for calculating a position correction amount vector by integrating the joint velocity vector that has been decomposed;
- and
- position control means for controlling positions of drive motors of the robot on the basis of a position command to which the position correction amount vector has been added.
4 more elements
A robot system comprising:
- a robot including at least main axes and wrist axes;
- first calculation means for calculating a first velocity error vector of a tip of a tool of the robot, the first velocity error vector being generated as a result of the robot following an external force applied to the tool disposed at an end of the robot;
- second calculation means for outputting a second velocity error vector, the second velocity error vector being obtained by selecting a vector component related to rotational movement in the first velocity error vector that has been calculated and by inverting a sign of the selected component;
- third calculation means for decomposing the second velocity error vector that has been output into a joint velocity vector of the main axes and the wrist axes;
- fourth calculation means for calculating a position correction amount vector by integrating the joint velocity vector that has been decomposed;
- and
- position control means for controlling positions of drive motors of the robot on the basis of a position command to which the position correction amount vector has been added.
4 more elements
Dependencies are inferred from the claim text.