Patent ID: 9050724
Filing Date: 2015-06-09
Classification: B25J,G05B

Abstract:
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.