Back to results
US 8,818,559 B2Granted
Robot apparatus and control method therefor
AssigneeToyota Jidosha Kabushiki Kaisha
InventorFukashi Andoh
Life of this patent
Estimating the term…
Abstract
A robot apparatus includes a robot mechanism having a plurality of joints, and actuators that drive joint axes of the robot mechanism. The robot apparatus includes a robot controller that controls the driving of the actuators based on a cost function that is a function of torque reference inputs for the actuators.
Claims16
A robot apparatus comprising:
- a robot mechanism having a plurality of joints;
- a plurality of actuators operable to drive joint axes of the robot mechanism;
- and
- a robot controller operable to drive the actuators based on a cost function that is a function of torque reference inputs for the actuators,
- wherein:
- the robot controller has a minimum-of-cost-function computation portion for calculating the minimum of the cost function, and the robot controller is operable to drive the actuators so that the value of the cost function calculated by the minimum-of-cost-function computation portion becomes minimum;
- and
- the robot apparatus further comprises position sensors operable to measure positions of the joint axes,
- wherein:
- the minimum-of-cost-function computation portion is operable to calculate as independent-axis position reference inputs the positions of the independent axes when the cost function becomes minimum;
- the robot controller further has an individual-axis feedback control portion operable to calculate independent-axis torque reference inputs such that the positions of the independent axes from the position sensors converge to the independent-axis position reference inputs calculated by the minimum-of-cost-function computation portion;
- the robot controller further has an individual-actuator weight computation portion operable to calculate individual-actuator weights that show a relative degree of importance of the plurality of actuators;
- the individual-axis feedback control portion has an independent-axis control portion operable to calculate control gains for the independent axes in proportion to the individual-actuator weights calculated by the individual-actuator weight computation portion, and, using the calculated control gains, is operable to calculate the independent-axis torque reference inputs;
- and
- the individual-actuator weight computation portion is operable to calculate an individual-actuator weight for each actuator according to a level of importance of motion of a corresponding joint axis caused by the actuator.
12 more elements
A control method for a robot apparatus that includes a robot mechanism having a plurality of joints, and a plurality of actuators that drive joint axes of the robot mechanism, the control method comprisinG
- controlling the actuators based on a cost function that is a function of torque reference inputs for the actuators,
- wherein:
- the controlling of the actuators includes calculating the minimum of the cost function, and driving the actuators so that the value of the cost function calculated becomes minimum;
- the method comprises detecting positions of the joint axes;
- the calculation of the minimum of the cost function includes calculating as independent-axis position reference inputs the positions of the independent axes when the cost function takes the minimum;
- the controlling of the actuators further includes calculating independent-axis torque reference inputs such that the positions of the independent axes measured converge to the independent-axis position reference inputs calculated;
- the controlling of the actuators includes calculating individual-actuator weights that show relative degrees of importance of the plurality of actuators;
- the calculation of the independent axis torque reference inputs includes calculating control gains for the independent axes in proportion to the individual-actuator weights calculated, and also includes calculating the independent-axis torque reference inputs using the control gains calculated;
- and
- the method comprises calculating an individual-actuator weight for each actuator according to a level of importance of motion of a corresponding joint axis caused by the actuator.
7 more elements
Dependencies are inferred from the claim text.