Control system for telemanipulation

• US 6,028,409 A
• Filed: 12/15/1998
• Issued: 02/22/2000
• Est. Priority Date: 12/17/1997
• Status: Expired due to Term

• Current Assignee: MOOG FCS BV
• Original Assignee: Fokker Control Systems BV
• Inventors: Wierda, Gerhard Johan
• Primary Examiner(s): IP, SHIK LUEN PAUL
• Application Number:
  US09/210,724
• Time in Patent Office: 434 Days
• Field of Search: 318/560-696, 318/69, 360/78.09, 360/78.06, 901/3, 901/5, 901/7, 901/13, 901/18, 901/23, 395/80-98, 395/800.31
• US Class Current: 318/568.1
• CPC Class Codes: B25J 9/16 Programme controls programme controls in general G05B19/00, e.g. numerical pogramme controls G05B19/18; recording or playback systems G05B19/42

Abstract

Remote control system comprising two circuits each containing an actuator acting on a mass and controlled by an actuator signal, a manual control means coupled to said actuator, a force transducer measuring the force applied to said manual control means, a velocity transducer measuring the velocity of the manual control means, a control circuit representing a model of the dynamics of a moving mass the input signal of which is divided by a simulated mass to obtain a commanded acceleration signal, which is time integrated to obtain a commanded velocity signal, an actuator controller the input signal of which is the balance between the commanded velocity signal and the velocity of the manual control means. The balance of the two measured forces is applied as input signal to both circuits.

Claims

1. Remote control system comprising

a first circuit containing:

a first actuator acting on a first mass and controlled by a first actuator signal,

a first manual control means coupled to said first actuator

a first force transducer measuring the force applied on the first manual control means,

a first velocity transducer measuring the velocity of the first manual control means,

a first control circuit representing a model of the dynamics of a moving mass the input signal of which is divided by a simulated mass to obtain a first commanded acceleration signal, which is time integrated to obtain a first commanded velocity signal,

a first actuator controller the input signal of which is the balance between the first commanded velocity signal and the velocity of the first manual control means,

a second circuit containing;

a second actuator acting on a second mass and controlled by a second actuator signal,

a second manual control means coupled to said second actuator,

a second force transducer measuring the force applied on the second manual control means,

a second velocity transducer measuring the velocity of the second manual control means,

a second control circuit representing a model of the dynamics of a moving mass the input signal of which is divided by a simulated mass to obtain a second commanded acceleration signal, which is time integrated to obtain a second commanded velocity signal,

a second actuator controller the input signal of which is the balance between the second commanded velocity signal and the velocity of the second manual control means,

whereby

the simulated mass in the first and second control circuit is a simulation of the sum of the first mass and the second mass and whereby

the balance of the two measured forces is applied as input signal to the first and second control circuits.

2. Remote control system according to claim 1, characterised in that the first velocity signal is time integrated to obtain a first commanded position signal and the second velocity signal is time integrated to obtain a second commanded position signal,

that the first circuit comprises furthermore

a first position transducer determining the position of the first manual control means

a comparator for comparing the first position transducer output signal with the first commanded position signal resulting into an error signal which is provided to the first actuator controller, and

that the second circuit comprises furthermore

a second position transducer determining the position of the second manual control means

a comparator for comparing the second position transducer output signal with the second commanded position signal resulting into an error signal which is provided to the second actuator controller.

3. Remote control system according to claim 2, characterised in that both error signals are attenuated or amplified before being provided to the respective controller.

4. Remote control system according to claim 1, characterised in that in the first circuit the first commanded acceleration signal is applied to the first controller and in the second circuit the second commanded acceleration signal is applied to the second controller.

5. Remote control system according to claim 4, characterised in that the first and second commanded acceleration signals are attenuated or amplified before being provided to the respective controller.

6. Remote control system according to claim 1, characterised in that the system comprises a comparator for comparing the first and second commanded velocity signal resulting in an error signal which is applied to the first and second actuator controllers.

7. Remote control system according to claim 6, characterised in that the error signal is attenuated or amplified before being provided to the first and second actuator controllers.

8. Remote control system according to claim 2, characterised in that the system comprises a comparator for comparing the first and second commanded position signal resulting in an error signal which is applied to the first and second actuator controllers.

9. Remote control system according to claim 8, characterised in that the error signal is attenuated or amplified before being provided to the first and second actuator controllers.

10. Remote control system according to claim 6, characterized in that instead of the commanded velocity and position signals the measured velocity and position signals, supplied by the respective transducers, are used to derive the mentioned error signals.

11. Remote control system according to claim 1, characterised in that the actuator controllers are embodied as PI controllers.

12. Remote control system according to claim 1, characterised in that

the first circuit receives the balance of the force measured by the first force transducer and the force measured by the second force transducer divided by a predetermined function, and that

the second circuit receives the balance of the force measured by the second force transducer and the force measured by the first force transducer multiplied by said predetermined function.

13. Remote control system according to claim 12 referring back to claim 6, characterised in that the first commanded velocity signal is multiplied by said predetermined function and the second commanded velocity signal is divided by said function before these signals are applied to said comparator.

14. Remote control system according to claim 12 referring back to claim 8, characterised in that the first commanded position signal is multiplied by said predetermined function and the second commanded position signal is divided by said function before these signals are applied to said comparator.

15. Remote control system according to claim 11, characterized in that the function is a constant factor, i.e. a gearing ratio.

16. Remote control system according to claim 11, characterized in that the function is dependent on one or more arbitrary variables.

17. Remote control system according to claim 1, characterised in that in each circuit the velocity transducer is omitted and that the respective velocity signal is obtained as an estimation based on the position or acceleration signals obtained from the respective transducers.

18. Remote control system comprising a number of the systems as described in claim 1 to control a corresponding number of degrees of freedom.

19. Control system according to claim 18, characterised in that at least a number of the necessary force transducers is combined into one transducer measuring multiple degrees of freedom.

20. Model follower control system comprising

an actuator acting on a mass and controlled by a first actuator signal,

a manual control means coupled to said actuator

a force transducer measuring the force applied on the manual control means,

a velocity transducer measuring the velocity of the manual control means,

a control circuit representing a model of the dynamics of a moving mass the input signal of which is divided by a simulated mass to obtain a commanded acceleration signal, which is time integrated to obtain a commanded velocity signal,

an actuator controller the input signal of which is the balance between the commanded velocity signal and the velocity of the manual control means.

21. Model follower control system according to claim 20, characterised in that, the follower furthermore comprises

a position detecting means providing a sensed position signal

a comparator comparing the sensed position signal and time integrated commanded velocity signal resulting into a position error signal which is, together with the commanded velocity signal provided to the actuator controller.

22. Model follower control system according to claim 20, characterised in that, the commanded acceleration signal together with commanded velocity signal and the position error signal is provided to the actuator controller.

23. Model follower control system according to claim 20, characterised in that the actuator controller is embodied as a PI controller.