US4989161A — Control unit for a multi-degree-of freedom manipu…

Claim 1

Independent Claim 154 words

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.

Claim 2

Dependent Claim 154 words

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.

Claim 3

Dependent Claim 83 words

The control unit for a multi-degree-of-freedom manipulator as claimed in claim 1 wherein said flexure and vibration compensation control system further comprises a third operator (F2) for producing an operational signal in accordance with the second correction value, an adder for adding a target value of a link angle (θer) and the second correction value as an actual twist angle (e), and a fourth operator for producing a target value of the motor angle (θmr) multiplied by the reduction gear ratio of N.

Claim 4

Dependent Claim 21 words

The control unit for multi-degree-of-freedom manipulator as claimed in claim 2 wherein said third operator F2 is a PID functional operator.

Claim 5

Dependent Claim 59 words

The control unit for a multi-degree-of-freedom manipulator as claimed in claim 1 wherein said motor rotational angle position control system comprises an angle sensor for detecting an actual rotational angle (θm) of the motor actuator and a second adder for adding a target value of the motor angle and an actual motor rotational angle signal from the angle sensor.

Claim 6

Dependent Claim 36 words

The control unit for a multi-degree-of-freedom manipulator as claimed in claim 4 wherein said operational means comprises a third adder for adding an output signal from the second adder and said first and second correction values.

Claim 7

Dependent Claim 37 words

The control unit for a multi-degree-of-freedom manipulator as claimed in claim 5 wherein said motor link system further comprises a fourth adder for adding an output signal from the third adder and a feedback signal of (-τ/N).

Claim 8

Dependent Claim 90 words

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.

Claim 9

Dependent Claim 90 words

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.

Claim 10

Dependent Claim 97 words

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.

Claim 11

Dependent Claim 97 words

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.

Claim 12

Dependent Claim 97 words

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; wherein the 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.

Claim 13

Dependent Claim 97 words

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; wherein the 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.

Annuity Stage	Window Opens	Payment Deadline	Surcharge Period Until	Estimated Fee	Status
3.5 Years (Year 4)	1994-01-28	1994-07-30	1995-01-29	$2000.00	Window Closed / Lapsed
7.5 Years (Year 8)	1998-01-28	1998-07-30	1999-01-29	$3760.00	Window Closed / Lapsed
11.5 Years (Year 12)	2002-01-28	2002-07-30	2003-01-29	$7700.00	Window Closed / Lapsed

Control unit for a multi-degree-of freedom manipulator

Abstract

Inventors

Bibliographic Details

Claims Analysis

References Cited (Backward Citations)

USPTO Annuity & Maintenance Windows

Assigned Categories & Tags

Assign Category Tag