Back to EveryPatent.com



United States Patent 5,203,220
Lerman April 20, 1993

Optical tracking and stabilizing system with a gimbal mounted mirror for establishing a line of sight

Abstract

An optical tracking and stabilizing system which generates an error signal to control a gimbal set, which error signal has first and second components. The first error signal component is a low frequency domain position servo error signal and the second error signal component is a high frequency domain inertial stable platform error signal.


Inventors: Lerman; Harold (Paramus, NJ)
Assignee: GEC-Marconi Electronic Systems Corp. (Wayne, NJ)
Appl. No.: 887860
Filed: May 26, 1992

Current U.S. Class: 74/5.22; 359/555; 701/220
Intern'l Class: G01C 019/00; G01C 021/00
Field of Search: 74/5.22 250/203.1,203.2 364/453 244/3.16 359/555


References Cited
U.S. Patent Documents
3931515Jan., 1976Parkin244/3.
4047678Sep., 1977Miller et al.244/3.
4881800Nov., 1989Fuchs et al.359/555.


Other References

"Modern Control Methods Applied to a Line-of-Sight Stabilization and Tracking System", Haessig et al., American Control Conference, Jun. 1987, pp. 29-36.

Primary Examiner: Bonck; Rodney H.
Attorney, Agent or Firm: Davis; David L.

Claims



I claim:

1. An optical tracking and stabilizing system for establishing and maintaining a line of sight in response to a position command signal, comprising:

a two-axis gimbal system controllable independently about each of its axes;

a rigid block mounted to said gimbal system;

a mirror mounted to said rigid block;

gyroscope means mounted to said rigid block for providing a gyro rate signal about each of the axes of said gimbal system;

means for providing a gimbal angle signal corresponding to the angular position of said rigid block about each of the axes of said gimbal system;

means for receiving an input line of sight position command signal which defines a desired line of sight position to be attained by said mirror; and

for each of said gimbal axes, means responsive to said gyro rate signal, said gimbal angle signal and said position command signal for generating an error signal to be applied to control said gimbal system, said error signal including first and second components, said first component passing through a high pass filter and corresponding to an inertial stable platform error signal based on said gyro rate signal, and said second component passing through a first low pass filter and corresponding to a position servo error signal based on said gimbal angle signal and said position command signal, wherein said high pass filter and said first low pass filter are mutually complementary.

2. The system according to claim 1 wherein said gimbal system is mounted to a vehicle and further comprising:

means for receiving a vehicle rate signal;

means for passing said vehicle rate signal through a second low pass filter to obtain a first signal;

means for generating a second signal which is the first derivative with respect to time of said position command signal;

means for passing said second signal through a third low pass filter to obtain a third signal;

means for summing said first and third signals to obtain a fourth signal; and

means for subtracting said fourth signal from said gyro rate signal to obtain a fifth signal which is used to generate said first component of said error signal.
Description



BACKGROUND OF THE INVENTION

This invention relates to an optical tracking system for establishing a line of sight in accordance with a position command signal and, more particularly, to such a system which is stabilized against environmental vibrations and perturbations.

U.S. Pat. No. 4,881,800, the contents of which are hereby incorporated by reference herein, discloses an optical tracking and stabilizing system for use in an aircraft vehicle which tracks the movement of the pilot's helmet by developing a position command signal which causes the line of sight of the optical system to follow the line of sight of the pilot. In the disclosed system, a mirror is flexibly mounted to a rigid block which in turn is fixedly mounted to the inner gimbal of a pair of gimbals. A gyroscope having a spin axis aligned with the line of sight of the optical system is mounted to the rigid block to develop signals which are utilized to control movement of the mirror relative to the rigid block so as to nullify vibrations which emanate both from the gimbal system during the positioning of the rigid block and from the vehicle.

In the referenced system, a first error signal is generated and applied to the gimbal system to control movement of the rigid block relative to the vehicle and a second error signal is generated and applied to the mirror subassembly to control movement of the mirror relative to the rigid block. It would be desirable to provide an arrangement which requires only a single error signal to control both the rigid block gimbal set and the limited motion mirror subassembly. Further, if the rigid block gimbal set has appropriate performance characteristics, the limited motion mirror subassembly is not needed.

As described in the referenced patent, in order to track the input position command and isolate the line of sight from angular vibration of the vehicle, the optical tracking and stabilizing system must behave like a position servomechanism in the low frequency domain and like an inertial stable platform in the high frequency domain. It is therefore an object of the present invention to provide an optical tracking and stabilizing system of the type described which permits independent control of the low frequency response to position command inputs, permits independent control of the high frequency isolation of the line of sight from the vehicle angular vibration, and does not compromise the ability of the system to reject the effects of disturbance torques over the full range of the system's frequency bandwidth.

SUMMARY OF THE INVENTION

The foregoing, and additional, objects are attained in accordance with the principles of this invention by providing an optical tracking and stabilizing system for establishing and maintaining a line of sight in response to a position command signal, comprising a two-axis gimbal system controllable independently about each of its axes, a rigid block mounted to the gimbal system, a mirror mounted to the rigid block, gyroscope means mounted to the rigid block for providing a gyro rate signal about each of the axes of the gimbal system, means for providing a gimbal angle signal corresponding to the angular position of the rigid block about each of the axes of the gimbal system, and means for receiving an input line of sight position command signal which defines a desired line of sight position to be attained by the mirror. For each of the gimbal axes, there is provided means responsive to the gyro rate signal, the gimbal angle signal and the position command signal for generating an error signal to be applied to control the gimbal system. The error signal includes first and second components, with the first component passing through a high pass filter and corresponding to an inertial stable platform error signal based on the gyro rate signal, and the second component passing through a first low pass filter and corresponding to a position servo error signal based on the gimbal angle signal and the position command signal, wherein the high pass filter and the first low pass filter are mutually complementary. In accordance with aspect of this invention, the gimbal system is mounted to a vehicle and further comprises means for receiving a vehicle rate signal, means for passing the vehicle rate signal through a second low pass filter to obtain a first signal, means for generating a second signal which is the first derivative with respect to time of the position command signal, means for passing the second signal through a third low pass filter to obtain a third signal, means for summing the first and third signals to obtain a fourth signal, and means for subtracting the fourth signal from the gyro rate signal to obtain a fifth signal which is used to generate the first component of the error signal.

DESCRIPTION OF THE DRAWINGS

The foregoing will be more readily apparent upon reading the following description in conjunction with the drawings in which like elements in different figures thereof are identified by the same reference numeral and wherein:

FIG. 1 is a pictorial depiction of a prior art optical tracking system in which the present invention may be incorporated;

FIG. 2 illustrates the gimbal system of the optical tracking system of FIG. 1;

FIG. 3 is a detailed illustration showing the elevation gimbal, the rigid block and the mirror of FIG. 2;

FIG. 4 is a general block diagram of an optical tracking and stabilizing system constructed according to this invention; and

FIG. 5 is a block diagram of the signal processing portion of the system of FIG. 4.

DETAILED DESCRIPTION

FIG. 1 illustrates an aircraft night vision optical tracking system having a line of sight, shown by the arrow 10, which tracks the line of sight of the pilot, shown by the arrow 12. In this system, an infrared image is captured and displayed on a screen attached to the pilot's helmet 14. The pilot can focus on this screen or look through the screen, seeing either an infrared image or a normal image, respectively. Therefore, the line of sight 10 of the system must accurately track the line of sight 12 of the pilot to provide proper image registration. The position of the pilot's helmet 14 relative to the cockpit of the aircraft is sensed magnetically and is sent by the transmitter 16 to the system electronics 18 to provide a position command signal.

As best illustrated in FIG. 2, the mechanical portion of the optical tracking system includes an azimuth gimbal 20 mounted to the aircraft structure 22, which acts as a ground plane, via the bearings 24 so as to be rotatable about an azimuth axis of rotation Z.sub.A. An elevation gimbal 26 is mounted to the azimuth gimbal 20 via the bearings 28 as to be rotatable about an elevation axis of rotation Z.sub.E. The fixed angle between the axes of rotation Z.sub.A and Z.sub.E is denoted as .phi.. In an orthogonal gimbal set, would be 90.degree. degrees. However, in the system shown herein, the gimbal set is non-orthogonal and .phi. is illustratively 45.degree. degrees.

Fixedly mounted to the elevation gimbal 26 is a rigid block 30. A mirror 32 is movably mounted to the rigid block 30 via a flexure hinge 34. The line of sight 10 of the tracking system is reflected off the mirror 32 at the same angle from the surface of the mirror 32 as that surface is to the elevation gimbal axis of rotation Z.sub.E.

FIG. 3 shows the elevation gimbal assembly in more detail. As shown therein, and as described in the aforereferenced U.S. Pat. No. 4,881,800, the mirror 32 is mounted to the rigid block 30 through the flexure hinge 34 which provides two axes of limited freedom and a small amount of restoring torque to the mirror 32. The end portion of the flexure hinge 34, as well as two pairs of torquer coils 36, is attached to the rigid block 30. Also attached to the block 30 are two pairs of proximity sensing pickoff coils 38. The pickoff and torquer coils 38, 36 are positioned concentrically with the flexure hinge 34 such that the two pairs of torquer coils 36 react with a permanent magnet ring 40, which is coupled to the underside of the mirror 32 within the mirror base 42. Similarly, the pickoff coils 38 react with a return path coil 44, also mounted to the mirror base 42.

Also included is a rate gyroscope 46 mounted to the rigid block 30 so that its spin axis 48 is parallel to the system line of sight 10, thereby providing rate information about two axes perpendicular to the line of sight 10. The gyroscope 46, in combination with high pass filters to be discussed hereinafter, is utilized to sense high frequency vibrational disturbances which result in jitter of the system line of sight 10. These vibrational effects arise from two sources. The first source is vehicle vibration. The second source is vibration generated by gimbal disturbance torques.

The line of sight tracking system with which the present invention is concerned uses a two axis gimbal set 20, 26 with adequate freedom of movement about each axis Z.sub.A, Z.sub.E to satisfy the field of regard requirements. The two axis rate gyroscope 46 is mounted on the inner cluster 26 of the gimbal set to sense the inertial angular rate of the gimbals. The two axes of the gimbal set contain angle transducers to measure the relative angles of the gimbal set and the gimbal axes also contain torquers to drive the gimbals. The system contains control amplifiers to amplify the error signals and power the gimbal torquers. For high accuracy applications, the inner cluster contains a small, limited motion two axis gimbal set mounting the mirror 32 to the rigid block 30. The limited motion gimbal set has a better performance capability than the full motion gimbal set. Thus, it can be used to improve the overall performance of the total system. The output of the limited motion gimbal set is optically added to the position of the inner cluster of the large motion gimbal set to achieve the improved accuracy line of sight output. Two types of sensor signals are available from the line of sight tracking system, i.e., the gyroscope signal and the gimbal angle transducer signal. The gyroscope 46 measures the inertial angular rate of the gimbals. The gimbal mounted angle transducer measures the relative gimbal angle. The present invention uses the described gimbal sets to accomplish its purpose, which is to solve the problem of line of sight tracking and stabilizing by introducing a means of sensor signal processing which:

1. Permits independent control of the line of sight tracking and stabilizing system low frequency response to line of sight command inputs;

2. Permits independent control of the line of sight tracking and stabilizing system high frequency isolation of the line of sight from vehicle angular vibration; and

3. Does not compromise the ability of the line of sight tracking and stabilizing system to reject the effects of disturbance torques over the full range of the system's frequency bandwidth.

The line of sight tracking and stabilizing system contains two gimbal axes to permit tracking the desired line of sight. Each gimbal is in a control feedback loop. For the purpose of explaining this invention, it is necessary to only describe one control feedback loop. The total system, of course, contains the two loops with the described signal processing contained in each loop.

FIG. 4 illustrates a general block diagram of an optical tracking and stabilizing system constructed according to this invention. The present invention is incorporated within the signal processor 102. The signal processor 102 receives feedback sensor signals from a respective one of the rigid block gimbal systems 20, 26. These feedback sensor signals are the gimbal angle signal on the lead 104 from the gimbal axis transducer, and the gimbal, or gyro, rate signal on the lead 106 from the gyroscope 46 indicative of the gimbal inertial rate. The signal processor 102 also receives the input position command signal on the lead 108 and the vehicle rate signal on the lead 110 from the inertial navigation system 112 of the vehicle. Within the limits of its performance, the signal processor 102 drives the gimbals 20, 26 to force the error signal on the lead 114 to zero. The residual error signal on the lead 114 is also fed to the limited motion mirror gimbal system 34. The output of the mirror gimbal system 34 is the line of sight correction signal on the lead 116. The outputs of the rigid block gimbal system 20, 26 and the mirror system 34 are optically added to produce the system line of sight 10.

FIG. 5 shows details of the signal processor 102 in block diagram form. However, it is understood that implementation of this design is preferably effected by a programmed computer. The signal processor 102 has four inputs 104, 106, 108 and 110, and one output 114. The output 114 represents the tracking and stabilizing system error signal .epsilon. and is the input to the gimbal systems shown in FIG. 4. The blocks shown in FIG. 5 represent transfer functions. The signal processor 102 includes the high pass filter 120 and the first low pass filter 122, which are mutually complementary. What this means is that the sum of the transfer functions for the filters 120 and 122 equals unity. The processor 102 also includes the second and third low pass filters 124 and 126, respectively, the adders 128, 130, 132 and 134, the integrator 136 and the differentiator 138. For the purposes of the following discussion, the definitions for the inputs, outputs and transfer functions are as follows: ##EQU1##

The operation of this invention can be explained by assuming that the tracking and stabilizing system error .epsilon. on the lead 114 is driven to zero by the full motion gimbal set 20 (or 26). For that error to be equal to zero, the values of the feedback terms on the leads 104 and 106 as a function of the input signals on the leads 108 and 110 are calculated. Performance limitations of the gimbal set will not drive the error to zero, but this does not invalidate this simple procedure for explaining the operation of this invention. The results illustrate the performance for a perfect gimbal set.

A quick review of conventional inertial stable platform operation and conventional position servo operation will help to explain the performance features of the inventive line of sight tracking and stabilizing system. First, observe the operation of an inertial stable platform. The integrator 136 output on the lead 140 is the error signal and is driven to zero by the gimbal set. This isolates the system from vehicle motion and drives the gimbal at a rate equal to the integrator input #2 (lead 142) command. For this situation: ##EQU2##

Second, observe the operation of the position servo. Lead 138 (line of sight error) is the servo error signal and is driven to zero by the gimbal set. The line of sight output follows the line of sight command input on the lead 108 regardless of vehicle rate. For this situation: ##EQU3##

For the stable platform, note that the inertial line of sight follows rate command regardless of vehicle rate. For the position servo, note that body line of sight follows the line of sight command input regardless of vehicle rate. Now observe the operation for the inventive mode of operation shown in FIG. 5. This mode may be termed a "hybrid" mode. In this case, the system error .epsilon. (lead 114) is driven to zero by the gimbal set. For the hybrid line of sight tracking and stabilizing system: ##EQU4##

Note that the use of the complementary filters 120, 122 in the signal processor 102 causes the resultant system to behave like an inertial stable platform in the high frequency domain (see equation set (1)) and like a position servo in the low frequency domain (see equation set (2)). The complementary filters 120, 122 accomplish an additional important function. All three configurations (stable platform, position servo, and hybrid tracking and stabilizing system) reject the effects of disturbance torque equally. The use of complementary filters 120, 122 in the signal processor 102 keeps the loop gain of the hybrid system equal to the loop gain of the stable platform and position servo. Thus, the disturbance torque rejection ability remains the same for all three systems.

However, the use of the complementary filters 120, 122 does not permit independent control of the frequency response to vehicle angular vibration rejection and frequency response to the line of sight command input. The corner frequencies for the high and low pass filters 120, 122 are equal. The use of the command rate signal (lead 142) permits the system to have independent control of the hybrid system frequency response to line of sight command inputs and vehicle angular vibration rejection. Set the command rate equal to the terms defined in the definition and shown in FIG. 5, lead 142. For this situation: ##EQU5##

If the bandwidth of the low pass filter 126 is greater than that of the filter 122, the high pass filter 120 effectively extends the equivalent bandwidth to that of the low pass filter 126. The system response to the line of sight command input is now controlled by the low pass filter 126.

The rejection of vehicle rate effects in the low frequency domain can be enhanced by the use of the low pass filter 124. It has the effect of creating its complementary high pass filter to increase the rejection of vehicle rate in the low frequency (line of sight tracking) domain while maintaining line of sight stabilization in the high frequency (stable platform) domain.

The third line in equation set (4) shows the additional degrees of freedom achieved when using the low pass filters 124 and 126. Compare this line to the last line in equation set (3).

Accordingly, there has been disclosed an improved optical tracking and stabilizing system for establishing and maintaining a line of sight in response to a position command signal. While an exemplary embodiment has been disclosed herein, it will be appreciated by those skilled in the art that various modifications and adaptations to the disclosed embodiment may be made and it is only intended that this invention be limited by the scope of the appended claims.


Top