Back to results
US 8,560,123 B2Granted
Robot and method of controlling cooperative work thereof
AssigneeSamsung Electronics Co., Ltd.
InventorJong Do Choi
Life of this patent
Estimating the term…
Abstract
Disclosed are a robot, which performs cooperative work with a plurality of robot manipulators through impedance control, and a method of controlling cooperative work of the robot. The method includes calculating absolute coordinate positions of end effectors, respectively provided at a plurality of manipulators to perform the work; calculating a relative coordinate position from the absolute coordinate positions of the end effectors; calculating joint torques of the plurality of manipulators using the relative coordinate position; and controlling the cooperative work of the plurality of manipulators according to the joint torques.
Claims17
A method of controlling cooperative work of a robot, the method comprising:
- inputting a target position;
- calculating absolute coordinate positions of end effectors of the robot, respectively provided at a plurality of manipulators of the robot to perform the work;
- determining whether the absolute coordinate positions of the end effectors reach the target position by comparing the calculated absolute coordinate positions with the input target position;
- and
- if it is determined that the absolute coordinate positions of the end effectors do not reach the target position,
- calculating a relative coordinate position from the absolute coordinate positions of the end effectors;
- calculating a relative Jacobian of one of the end effectors opposite to another one of the end effectors;
- calculating joint torques of the plurality of manipulators using the target position, the calculated relative coordinate position and the calculated relative Jacobian;
- and
- controlling the cooperative work of the plurality of manipulators according to an order of the calculated joint torques;
- wherein the calculating of the relative Jacobian comprises acquiring an impedance control input using a Jacobian matrix according to the relative coordinate position.
8 more elements
A method of controlling cooperative work of a robot comprising:
- inputting a target position;
- calculating absolute coordinate positions of first and second end effectors, respectively provided at first and second manipulators to perform the work;
- determining whether the absolute coordinate positions of the end effectors reach the target position by comparing the absolute coordinate positions of the first and second end effectors with the input target position;
- if it is determined that the absolute coordinate positions of the first and second end effectors do not reach the target position,
- calculating a relative coordinate position of one of the end effectors from the absolute coordinate position of the other of the end effectors;
- calculating a relative Jacobian of one of the end effectors relative to the other end effector;
- calculating joint torques of the first and second manipulators using the relative coordinate position;
- and
- controlling the cooperative work of the first and second manipulators according to the calculated joint torques;
- wherein the calculating of the relative Jacobian comprises acquiring an impedance control input using a Jacobian matrix according to the relative coordinate position calculated from the absolute coordinate positions.
7 more elements
A robot comprising:
- a plurality of manipulators to perform work;
- a plurality of end effectors respectively provided at the plurality of manipulators;
- a target position input unit to input a target position;
- a plurality of current position calculating units to calculate absolute coordinate positions of the end effectors;
- a position comparing unit to compare the calculated absolute coordinate positions of the end effectors with the input target position, and determines whether or not the absolute coordinate positions of the end effectors reach the input target position;
- a relative position calculating unit to calculate a relative coordinate position from the absolute coordinate positions of the plurality of end effectors if it is determined that the absolute coordinate positions of the end effectors does not reach the input target position;
- a control unit to calculate joint torques of the plurality of manipulators using the relative coordinate position and to control the cooperative work of the plurality of manipulators according to the calculated joint torques;
- and
- a relative Jacobian generating unit to calculate a relative Jacobian of an end effector opposite to another one of the end effectors,
- wherein the relative Jacobian generating unit acquires an impedance control input using a Jacobian matrix using the relative coordinate position.
7 more elements
Dependencies are inferred from the claim text.