Background of the Invention
This invention relates to a guidance system using multiple sensors and more particularly to a circuit which combines the functions of a synchronous detector, amplifier and low pass filter in such a guidance system.
In guidance systems of the type which have sensors for following an externally defined path, such as magnetic coil sensors which detect an energized buried wire, the sensor signals must be detected in such a way as to eliminate spurious electronic signals referred to hereinafter as noise. Such noise can be generated by external magnetic fields as well as magnetic fields produced by the vehicle's own electro-mechanical equipment, such as electric motors and the like. A guidance system of the type which is referred to is described in U.S. Pat. No. 4,043,428.
Summary of the Invention
The present invention comprises a detector circuit for receiving an alternating current input signal, such as a guidance sensor signal, and for generating therefrom a direct current output signal whose magnitude is proportional to the amplitude of the input signal. The detector circuit includes means for generating a binary signal which is true during minus half cycles of the input signal and which is false during positive half cycles of the input signal, differential amplifier means having an output terminal, a first, noninverting input terminal and a second, inverting input terminal, first signal integrating means connected to the first input terminal of the differential amplifier means for time integrating signals supplied thereto, and second signal integrating means connected between the output terminal and the second input terminal of the differential amplifier means.
Switch means, which are controlled by the binary signal, supply the positive half cycles of the input signal to the first input terminal and the negative half cycles of the input signal to the second input terminal. In this way, the direct current level of the output of the differential amplifier will rise as the amplitude of the input signal increases; just enough to keep the voltages on the first and second input terminals of the differential amplifier means equal. The output voltage of the differential amplifier will therefore be proportional to the amplitude of the sensor signal.
In the preferred embodiment, the binary signal generating means comprise a bandpass filter which is supplied with the input signal. The output of the bandpass filter is supplied to a voltage comparator which generates the binary signal. Where multiple sensors are utilized, the outputs of all the sensors are fed through suitable isolating resistors to the input terminal of the bandpass filter. Each sensor is provided with separate differential amplifier means, separate first and second integrating means and separate switch means. The single binary signal from the voltage comparator is then supplied to the separate switch means so that separate DC level output signals for each sensor are provided.
These DC level output signals are converted to digital signals and are applied to the input of a microcomputer which, through a digital to analog converter, controls the pulse width modulated steering motor driver of the vehicle which is to be guided.
By having the frequency of all four sensor circuits be determined by a single bandpass filter, the tuning and frequency selection for the system is greatly simplified. The system of the invention also eliminates mismatches in detector gain due to variations in tuning accuracy.
It is therefore an object of the present invention to provide a combined synchronous detector, amplifier and low pass filter in a guidance system detector circuit.
It is another object of the invention to provide a combined synchronous detector, amplifier and low pass filter in a single inexpensive circuit.
It is still another object of the invention to provide a guidance system detector circuit which is relatively immune to noise signals.
It is still a further object of the invention to provide a guidance system detector circuit which has simplified tuning and frequency selection in a multi-frequency system.
It is yet another object of the invention to provide a guidance system detector circuit which eliminates mismatches in detector gain due to variations in tuning accuracy.
The novel features which are believed to be characteristic of the invention, both as to organization and method of operation, together with further advantages thereof, will be better understood from the following drawings, in which several preferred embodiments of the invention are illustrated by way of example.
Brief Description of the Drawings
FIG. 1 is a block diagram of the guidance system detector circuit according to the invention;
FIG. 2 is a schematic diagram of the detector/filter/amplifier circuit of the system depicted in FIG. 1; and
FIG. 3 is a series of waveform diagrams for use in illustrating the operation of the system depicted in FIG. 1.
Detailed Description of the Preferred Embodiments
Referring now more particularly to FIG. 1, a series of separate magnetic coil sensors 10a, 10b, 10c and 10d are each connected to the inputs of separate differential amplifiers 11a, 11b, 11c and 11d. The outputs of the amplifiers 11a through 11d are supplied to separate detector circuits 12a, 12b, 12c and 12d, respectively. As will be explained in greater detail hereinafter, the outputs of the detectors are proportional to the amplitudes of the individual sensor signals and are able to disregard noise signals.
The separate detector output signals are fed through an analog to digital converter 14 and are input to a microprocessor 16. The microprocessor receives forward, reverse and stop signals from separate manual inputs 17 (not shown).
The microprocessor 16 supplies a series of appropriate digital output signals to a digital to analog converter 18. The analog output controls a pulse width modulated steering motor driver circuit 20, of the type which is described more fully in the applicant's earlier referred to patent. Motor driver circuit 20, in turn, controls the motor 22 which turns the ground engaging steering wheel of the guided vehicle so that the vehicle will follow along the path defined by the energized, buried wire.
The outputs of each of the amplifiers 11a, 11b, 11c and 11d are connected through separate resistors 26a, 26b, 26c and 26d, respectively, to the input of a bandpass filter 24. Thus, the input to the bandpass filter 24 is the sum of all of the sensor signals. The bandpass filter generates a synchronous reference signal which is supplied to one input of a comparator 28 whose other input is the circuit ground. The comparator 28 converts the bandpass filter output to a binary signal which is true during the minus half cycles of the input sensor signals and is false during the plus half cycles.
With reference to FIG. 3, if the input signal waveform is basically sinusoidal with a decreasing amplitude, as illustrated by the waveform 46, the reference signal out of the comparator 28 will be the binary waveform 48 depicted in FIG. 3. It should be understood that the waveform 46 is merely one example of the typical waveform and other sinusoidal waveforms of differing amplitude variations could be expected. This binary reference signal 48 is supplied to each of the detectors 12a, 12b, 12c and 12d.
Referring now more particularly to FIG. 2, the details of a typical one of the detector circuits 12 is illustrated. The incoming signal 46 from the sensor amplifier 11 is fed through a resistance 30 to the pole terminal of a single pole double throw switch 32. Actually, the switch 32 is just one-fourth of a CMOS 4-pole-double-throw electronic switch. One contact of the switch 32 is supplied to the inverting (-) input 34 of a differential amplifier 36. The other contact of the switch 32 is connected to the noninverting (+) input 38 of the amplifier 36.
A first parallel connected resistance-capacitance integrating circuit 40 is connected between the input 38 and the circuit ground. A second RC integrating circuit 42 is connected between the output 44 of the amplifier 36 and the input 34.
In operation, whenever the reference signal 48 is true, it causes the switch 32 to connect the resistance 30 to the inverting input of the amplifier 36. When the reference signal is false, the switch 32 connects the resistance 30 to the noninverting input of the amplifier 36. Since the time constant of the integrating circuit 40 applied to the noninverting input 34 is several orders of magnitude slower than the frequency of the reference signal 48, the voltage on the input 34 will be the average sensor signal value during the plus half cycles of the reference signal. Referring again to FIG. 3 where the waveforms at the inputs and output of the amplifier have been appropriately referenced, if the average sensor signal value during minus half cycles is the same as during the plus half cycles, the output of the amplifier 36 will be zero. As the sensor signal amplitude increases, the difference between the average voltage during plus half cycles and during minus half cycles increases and the detector circuit 12 in effect acts as a full wave rectifier. Thus, the DC level of the output 44 will rise as the sensor signal level increases just enough to keep the voltage on the two inputs to the amplifier 36 equal. The output voltage is thus proportional to the amplitude of the input sensor signal.
Since noise signals and signal frequencies other than the one selected by the bandpass filter 24 are not coherent with the reference signal 48, their average value is the same during the plus and minus half of the reference signal. The output thus is a measure of amplitude of only the portion of the input signal which is coherent with the reference signal 48. Note that the frequency of all four detector circuits 12a, 12b, 12c and 12d is determined by the single bandpass filter 24. This greatly simplifies tuning and frequency selection for multifrequency systems. It also eliminates mismatches in detector gain due to variations in tuning accuracy.
The terms and expressions which have been employed here are used in terms of description and not of limitation and there is no intention, in the use of such terms and expressions, of excluding equivalents of the features shown and described, or portions thereof, it being recognized that various modifications are possible within the scope of the invention as claimed.