DUAL INPUT SERVO COUPLED CONTROL STICKS

• US 20020135327A1
• Filed: 03/22/2001
• Published: 09/26/2002
• Est. Priority Date: 03/22/2001
• Status: Active Grant

• Current Assignee: MPC Products Corporation (Woodward Incorporated)
• Original Assignee: MPC Products Corporation (Woodward Incorporated)
• Inventors: Makhlin, Alex, Dyra, Brian, Szulyk, Zenon
• Granted Patent: US 6,459,228 B1
• Time in Patent Office: Days
• US Class Current: 318/34
• CPC Class Codes: G05D 1/085 to ensure coordination between different movements

Abstract

The present invention provides an active control system for coupling the movements of a pair of independently operated manual input devices such as dual flight control sticks operated by a pilot and co-pilot flying an aircraft. Each input device is configured to receive manual input data in the form of angular displacement of the device about one or more rotational axes. The active control system provides desired tactile feedback to an operator who displaces one of the manual input devices in the form of a restorative centering force. If an external system such as an auto-pilot system is engaged, the restorative force may be in a direction necessary to reconcile manual displacement of the input device with a position commanded by the external system, rather than directed toward the center position. The system also acts to reflect manual displacement of each input device as a force applied to the other. For example, when a pilot moves his or her control stick forward, the co-pilot will feel a like force tending to move the co-pilot'"'"'s control stick forward.

Claims

1. An active control system for applying desired force versus displacement characteristics to each of a first input device and a second input device, each input device being configured to receive a manual torque input for angularly displacing the input device about a control axis associated therewith, the active control system comprising:

first and second motors coupled to the first and second input devices for applying a restorative torque to the first and second input devices about their respective control axes;

a first servo control loop associated with the first motor and a second servo control loop associated with the second motor, each servo control loop comprising a position sensor for generating a position signal indicative of the angular position of the input device associated therewith, a force profile gain amplifier, and a servo controller, the force profile gain amplifier receiving and amplifying a position error signal derived from the position signal, the gain of the force profile amplifier being a function of the angular position of the input device, the output of the force profile gain amplifier comprising a torque error signal input to the servo controller, the servo controller generating current of polarity and magnitude to drive the motor in a direction opposite the direction of displacement of the input device, applying a restorative torque to the input device having a magnitude proportional to the magnitude of the error signal input to the servo controller; and

a cross-coupling feedback loop for reflecting the relative positions of the first and second input devices in the torque error signal input to the servo controllers associated with the first and second servo control loops so that the torque applied to the first and second input devices acts to reconcile the positions therebetween.

2. The active control system of claim 1 further comprising a command signal representing an angular position to which the first and second input devices are being commanded by an external control system, the position error signals associated with the first and second servo control loops comprising the angular position signal associated with each respective input device subtracted from the command signal.

3. The active control system of claim 2 wherein each of the first and second servo control loops further comprise a velocity damping loop wherein an angular velocity signal proportional to the angular velocity of the input device is amplified by a damping profile amplifier, and a velocity damping signal output from the damping profile amplifier is subtracted from the torque error signal.

4. The active control system of claim 3 wherein the damping profile amplifier has a variable gain output which is a function of the angular velocity of the input device.

5. The active control system of claim 2 wherein the cross-coupling feedback loop includes a relative position signal comprising the difference between the angular position signal of the second input device and the angular position signal of the first input device, and a proportional gain amplifier for amplifying the relative position signal.

6. The active control system of claim 5 wherein the cross-coupling feedback loop further includes an integrating amplifier for integrating the relative position signal.

7. The active control system of claim 6 wherein the cross-coupling feedback loop further comprises a relative velocity signal comprising the difference between the first input device angular velocity signal and the second input device angular velocity signal.

8. The active control system of claim 7 wherein an integrated relative position signal output from the integrating amplifier is added to the proportionally amplified relative position signal output from the proportional gain amplifier and the relative velocity signal is subtracted from the integrated relative position signal and the proportionally amplified relative position signal to form a cross-coupled position signal.

9. The active control system of claim 8 wherein the cross-coupling feedback loop further comprises a cross-coupled damping amplifier for amplifying the cross-coupled position signal, the damped cross-coupled position signal output from the cross-coupled damping amplifier being added to the torque error signal of one of the first and second servo control loops and subtracted from the torque error signal of the other of the first and second servo control loops.

10. The active control system of claim 1 wherein the cross-coupling feedback loop comprises a damped proportional integral derivative signal based on the difference between the position signal associated with the first input device, and the position signal associated with the second input device.

11. An active control system for supplying tactile feedback to a pair of manual input devices comprising:

first and second manual input devices, each adapted to receive input in the form of a manual torque applied to displace the input device about a control axis;

first and second servo control loops each comprising a servo motor coupled to a respective one of the input devices to apply a controlled restoring torque thereto about the associated control axis, and a servo controller for providing drive current to the motor of polarity necessary to drive the motor in a direction reducing the magnitude of a torque error signal and of a magnitude proportional to the magnitude of the torque error signal;

each of the first and second servo control loops further comprising a position feedback loop and a velocity feedback loop, the position feedback loop providing a position error signal proportional to the difference between the angular position of the input device and a commanded position, the position error signal being input to and amplified by a force profile gain amplifier having a variable gain output dependent on the angular position of the input device; and

a cross-coupling feedback loop comprising a relative position error signal representing the difference in angular position between the first and second input devices, the relative position error signal being added to the error signal input to the servo controller associated with one of the first and second servo control loops, and subtracted from the error signal input to the servo controller associated with the other of the first and second servo control loops.

12. The active control system of claim 11 wherein the commanded position is determined by a command signal generated by an external control device.

13. The active control system of claim 12 wherein the first and second manual input devices comprise first and second flight control sticks, and the command signal is generated by an autopilot system.

14. The active control system of claim 11 wherein the gain of the force profile gain amplifier increases linearly with increases in angular displacement of the input device.

15. The active control system of claim 11 wherein the gain of the force profile gain amplifier comprises a compound force profile, the gain increasing linearly at a first rate with displacement of the input device over a first range of displacement angles, and increasing linearly at a second rate over a second range of displacement angles.

16. The active control system of claim 11 wherein the cross-coupling feedback loop comprises a damped proportional integral derivative signal based on the difference between an angular position signal associated with the first input device, and an angular position signal associated with the second input device.

18. The active control system of claim 11 wherein the velocity feedback loop comprises a velocity signal representing the angular velocity of the input device which is input to a velocity damping profile amplifier having a variable gain output depending on the magnitude of the velocity signal.

20. The active control system of claim 19 wherein the cross-coupled feedback loop includes a relative position signal comprising the difference between an angular position signal associated with the second input device and an angular position signal associated with the first input device, and a proportional gain amplifier for amplifying the relative position signal.

21. The active control system of claim 20 wherein the cross-coupled feedback loop further includes an integrating amplifier for integrating the relative position signal.

22. The active control system of claim 21 wherein the cross-coupled feedback loop further comprises a relative velocity signal comprising the difference between a first input device angular velocity signal and a second input device angular velocity signal.

23. The active control system of claim 22 wherein an integrated relative position signal output from the integrating amplifier is added to a proportionally amplified relative position signal output from the proportional gain amplifier and the relative velocity signal is subtracted from the integrated relative position signal and the proportionally amplified relative position signal to form a cross-coupled position signal.

24. The active control system of claim 23 wherein the cross-coupled feedback loop further comprises a cross-coupled damping amplifier for amplifying the cross-coupled position signal, the damped cross-coupled position signal output from the cross-coupled damping amplifier being added to a torque error signal associated with of one of the first and second servo control loops and subtracted from a torque error signal associated with the other of the first and second servo control loops.

19. An active control system for applying a restorative torque to a pair of self-centering manual input devices, the system comprising:

a first servo loop configured to apply a restorative torque to a first input device;

a second servo loop configured to apply a centering torque to a second input device;

a cross-coupled feedback loop wherein a first position signal indicative of an angular position of the first input device is fed back to the second servo loop to influence the magnitude of the restorative torque applied to the second input device, and a second position signal indicative of an angular position of the second input device is fed back to the first servo control loop to influence the magnitude of the restorative torque applied to the first input device; and

wherein each of the first and second servo loops includes a velocity damping feedback loop comprising a velocity signal indicative of the angular velocity of the associated input device, and a velocity profile damping amplifier having a velocity sensitive variable gain for amplifying the velocity feedback signal.