Control method of robot apparatus and robot apparatus

摘要

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 computation step; a change computation step of computing a difference between the joint stiffness command value and a value and performing a computation of subtracting a value from the joint stiffness command value; an iterative step of iterating the computations of the torque command value computation step and the change computation step until the difference converges to a value equal to or smaller than a predetermined value; and a driving force command value computation step to compute each of the driving force command values when the difference is converged to a value equal to or smaller than the predetermined value.

主权项

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 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 computation step of using the target trajectory, angular velocity of the target trajectory, angular acceleration of the target trajectory, and a joint stiffness command value indicating a total value of the driving force command values to calculate a torque command value indicating the torque necessary for the joint based on inverse dynamics of the link; a change computation step of computing a difference between the joint stiffness command value and a value, which is obtained by dividing an absolute value of the torque command value by a moment arm radius of the link, and performing a computation of subtracting a value, which is obtained by multiplying the difference by a coefficient greater than 0 and equal to or smaller than 1, from the joint stiffness command value to change the joint stiffness command value; an iterative step of iterating the computations of the torque command value computation step and the change computation step until the difference converges to a value equal to or smaller than a predetermined value; and a driving force command value computation step of using the joint stiffness command value and the torque command value to compute each of the driving force command values when the difference is converged to a value equal to or smaller than the predetermined value.