Control unit for a multi-degree-of freedom manipulator
First Claim
1. A control unit for a multi-degree-of-freedom manipulator and having a motor link system including a motor for producing an output torque at each joint shaft actuator and a motor rotational angle position control system, which further comprises:
- a non-linear and interference force compensation control system having a torque sensor for detecting a torque (τ
) exerting on each joint shaft and a first operator;
a flexure and vibration compensation control system having a second operator,a first correction value being produced through said first operator which multiplies a torque signal (τ
) produced from the torque sensor by a reciprocal of a reduction gear ratio (1/N),a second correction value being produced through said second operator which multiplies the torque signal (τ
) produced from the torque sensor by a reciprocal of a spring constant (1/KG) of each joint; and
operational means for adding the first and second correction values to input signals to the motor actuator.
1 Assignment
0 Petitions
Accused Products
Abstract
A control unit for a multi-degree-of-freedom manipulator comprising a torque sensor for detecting the force exerting on each joint shaft and operational means for adding first and second correction values to the input signals to the motor actuator in accordance with the torque signal produced from the torque sensor. With this construction, non-linear and interference forces as well as effects due to the low rigidity of the joints can be removed without identifications of the link or arm parameters, and a striking improvement of the control performance can be achieved.
-
Citations
9 Claims
-
1. A control unit for a multi-degree-of-freedom manipulator and having a motor link system including a motor for producing an output torque at each joint shaft actuator and a motor rotational angle position control system, which further comprises:
-
a non-linear and interference force compensation control system having a torque sensor for detecting a torque (τ
) exerting on each joint shaft and a first operator;a flexure and vibration compensation control system having a second operator, a first correction value being produced through said first operator which multiplies a torque signal (τ
) produced from the torque sensor by a reciprocal of a reduction gear ratio (1/N),a second correction value being produced through said second operator which multiplies the torque signal (τ
) produced from the torque sensor by a reciprocal of a spring constant (1/KG) of each joint; andoperational means for adding the first and second correction values to input signals to the motor actuator. - View Dependent Claims (2, 3, 4, 5, 6)
-
-
7. A control unit for a multi-degree-of-freedom manipulator, comprising:
-
a motor; a reduction gear; and a link;
said control unit comprising;a torque sensor for detecting any torque exerted upon the input of said link; a means connected to said torque sensor for multiplying any torque detected by said torque sensor by the reciprocal number of the reduction ratio of said reduction gear; and a means connected to said multiplying means for increasing the input signal to said motor by the torque multiplied by the reciprocal number of the reduction ratio.
-
-
8. A control unit for a multi-degree-of-freedom manipulator having a motor actuator by which an output torque is produced through each joint shaft, which comprises:
-
torque sensing means for detecting the force exerted on each joint shaft; and operational means for adding first and second correction values to input signals to the motor actuator in accordance with a torque signal produced from said torque sensing means. wherein the first correction value to be applied to one input of the operational means is equal to the torque signal divided by the reduction gear ratio of the motor actuator side.
-
-
9. A control unit for a multi-degree-of-freedom manipulator having a motor actuator by which an output torque is produced through each joint shaft, which comprises:
-
torque sensing means for detecting the force exerted on each joint shaft; and operation means for adding first and second correction values to input signals to the motor actuator in accordance with a torque signal produced from said torque sensing means;
whereinthe second correction value to be applied to an input of the operational means is equal to the torque signal divided by a reduction gear ratio of the motor actuator side.
-
Specification