Control method of robot apparatus and robot apparatus

Patent metadata

Field	Value
Publication number	US-9050724-B2
Application number	US-201213722382-A
Country	US
Kind code	B2
Filing date	Dec 20, 2012
Priority date	Feb 13, 2012
Publication date	Jun 9, 2015
Grant date	Jun 9, 2015

Abstract

A control method of a robot apparatus, the robot apparatus including a link and a pair of actuators, obtaining each driving force command value of each of the actuators, and controlling each of the actuators, the control method including: a torque command value calculation step of using the target stiffness, the target trajectory, angular velocity of the target trajectory, and angular acceleration of the target trajectory to calculate a torque command value; a determination step of determining whether each of the driving force command values is a value 0 or greater; a change step of performing at least one of a change of increasing the target stiffness and a change of reducing the angular acceleration; and a driving force command value calculation step of using the target stiffness and the torque command value to calculate each of the driving force command values.

First claim

What is claimed is:

1. A control method of a robot apparatus, the robot apparatus comprising: a link pivotally connected to a base body through a joint; and a pair of actuators that generate driving force for pulling the link in opposite directions relative to the base body to provide torque to the joint based on a difference in the driving force and to provide stiffness to the joint based on a sum of the driving force, the robot apparatus causing the stiffness of the joint to coincide with target stiffness, the robot apparatus obtaining each driving force command value of each of the actuators necessary for a joint angle of the joint to follow a target trajectory, the robot apparatus controlling each of the actuators so that the driving force generated in each of the actuators coincides with each of the driving force command values, the control method comprising:
a torque command value calculation step of using the target stiffness, the target trajectory, angular velocity of the target trajectory, and angular acceleration of the target trajectory to calculate a torque command value indicating the torque necessary for the joint based on inverse dynamics of the link;
a determination step of determining whether each of the driving force command values, which is obtained using the torque command value calculated in the torque command value calculation step and using the target stiffness, is a value 0 or greater;
a change step of performing at least one of a change of increasing the target stiffness and a change of reducing the angular acceleration of the target trajectory if it is determined that at least one of the driving force command values is a negative value in the determination step and returning to the torque command value calculation step; and
a driving force command value calculation step of using the target stiffness and the torque command value to calculate each of the driving force command values if it is determined that each of the driving force command values is a value 0 or greater in the determination step.

2. The control method of the robot apparatus according to claim 1 , the control method further comprising
a corrected torque command value calculation step of calculating a corrected torque command value for compensating a difference between the angle of the joint and the target trajectory, wherein
in the driving force command value calculation step, a result obtained by adding the corrected torque command value obtained in the corrected torque command value calculation step to the torque command value obtained in the torque command value calculation step is used as the torque command value used for the calculation of each of the driving force command values.

3. A robot apparatus comprising:
a link pivotally connected to a base body through a joint;
a pair of actuators that generate driving force for pulling the link in opposite directions relative to the base body to provide torque to the joint based on a difference in the driving force and to provide stiffness to the joint based on a sum of the driving force; and
a control unit that causes the stiffness of the joint to coincide with target stiffness and that obtains each driving force command value of each of the actuators necessary for a joint angle of the joint to follow a target trajectory to control each of the actuators so that the driving force generated in each of the actuators coincides with each of the driving force command values, wherein
the control unit executes:
a torque command value calculation process of using the target stiffness, the target trajectory, angular velocity of the target trajectory, and angular acceleration of the target trajectory to calculate a torque command value indicating the torque necessary for the joint based on inverse dynamics of the link;
a determination process of determining whether each of the driving force command values, which is obtained using the torque command value calculated in the torque command value calculation process and using the target stiffness, is values 0 or greater;
a change process of performing at least one of a change of increasing the target stiffness and a change of reducing the angular acceleration of the target trajectory if it is determined that at least one of the driving force command values is a negative value in the determination process and returning to the torque command value calculation process; and
a driving force command value calculation process of using the target stiffness and the torque command value to calculate each of the driving force command values if it is determined that each of the driving force command values is a value 0 or greater in the determination process.

4. The robot apparatus according to claim 3 , wherein
the control unit executes a corrected torque command value calculation process of calculating a corrected torque command value for compensating a difference between the angle of the joint and the target trajectory, and in the driving force command value calculation process, uses a result obtained by adding the corrected torque command value obtained in the corrected torque command value calculation process to the torque command value obtained in the torque command value calculation process as the torque command value used for the calculation of each of the driving force command values.

Assignees

• Canon Kk

Inventors

• Takagi Kiyoshi

Classifications

• G05B2219/41387

  Observe reference torque, position and feedback position, estimate contact force · CPC title

• B25J9/1633 Primary

  compliant, force, torque control, e.g. combined with position control · CPC title