| 摘要 |
First of all, in a first step S 1 , each actuator command value for position command value and posture command value of an end-effector is determined. Next, in a second step S 2 , rotational resistance values of a first and a second universal joints are obtained, and in a third step S 3 , the force and the moment exerted to each of the second universal joints are computed using this, and in a fourth step S 4 , the resultant force and the resultant moment exerted to the end-effector are determined from these. Then, in the fifth step, the elastic deformation amount of a mechanism is computed using these, and a compensation amount of the actuator command value is computed using these values. And then, in the sixth step, the actuator command values determined in the first step are updated with the compensation amount determined in the fifth step taken into account.
|
