Information
-
Patent Grant
-
6031350
-
Patent Number
6,031,350
-
Date Filed
Tuesday, March 17, 199826 years ago
-
Date Issued
Tuesday, February 29, 200024 years ago
-
Inventors
-
-
Examiners
Agents
-
CPC
-
US Classifications
Field of Search
US
- 318 653
- 318 599
- 318 656-660
- 318 696
- 318 685
- 318 254
- 318 439
- 318 138
- 318 807-811
- 388 804
- 388 801
- 388 805
- 388 811-814
- 388 819
- 388 820
-
International Classifications
-
Abstract
A position control and monitoring circuitry is provided for an electric motor having a plurality of coils and a movable element. A drive circuit generates a square wave drive signal of variable mark/space ratio to drive the coils to position the movable element. A monitoring circuit modulates square wave transitions at a sub-harmnonic of the drive signal frequency and generates a monitoring signal for injection into the coils. A sensor senses the monitoring signal from the coils to determine the position of the movable element. A difference circuit drives the drive circuit with a difference between an input signal and an output signal of the sensor.
Description
The present invention relates to means for driving and controlling an electric motor. Particularly, but not exclusively the invention relates to means for driving and controlling a linear electromagnetic motor, which comprises an integral position measurement system providing information on the output movement produced and enabling servo position control. A motor of this type is described in a prior GB Patent Application 9517603.8.
The control electronics required by such motors must provide power drive to the device, in order for it to produce mechanical output power, and must simultaneously provide precision excitation signals for the integral position measurement system. In addition a means of extracting and signal conditioning the resultant position signal and for implementing the servo control loop is required. The performance. efficiency, and cost of manufacture of systems employing such actuators is critically dependent on the concept and design of the associated drive and control electronics.
FIG. 1 of the accompanying drawing shows a linear motor and integral position measurement system of the type to which this invention is particularly relevant, and FIGS. 2a, 2b and 2c show the equivalent circuit or electrical schematic representations of the motor. The figures show the motor to consist basically of two or four inductive circuit elements which are connected in a half bridge according to FIGS. 2a and 2b or full bridge configuration as in FIG. 2c. DC or quasi-static DC drive voltage is applied across the bridge in combination with a superimposed steady state AC excitation signal to provide energization for the position measurement function. The resultant position signal appears as a single ended output at the node of the half bridge circuit or as a differential output at the mid point of the full bridge configuration. Imbalance of the bridge is bought about by movement of the magnet and pole piece assembly--which creates differential incremental changes in the inductance of the windings. As described in GB Patent application 9517603.8, interconnection of the windings is arranged such that the forces produced on the magnet assembly by current flow in the coils contribute in unison, whilst the incremental changes in inductance are lumped according to their sign in the relevant arms of the half bridge or full bridge circuits.
The present invention sets out to provide a combined power drive, transducer excitation and signal conditioning system and position control loop, which performs simultaneously to maxirnise the overall electromechanical efficiency of the system and to realise the capabilities of the integral position measurement of the actuator.
According to the invention there is provided an electronic system, comprising a power amplifier with antiphase outputs for driving the actuator/transducer assembly, a pre-amplifier for receiving output signals from the actuator/transducer assembly, an input command signal, and an excitation and signal conditioning circuit which functions to combine the outputs of the pre-amplifier, the input command signal, and a periodic excitation signal to provide input signals to the power amplifier for driving the actuator/transducer assembly.
The excitation and signal conditioning circuit may comprises an error conditioning and converter stage, which provides input to the power amplifier and a transducer excitation function generator, which provides periodic signals for combination with the input signals to the power amplifier.
Preferably the excitation and signal conditioning circuit includes a stage which transforms the input command signal supplied to the system to a suitable form for feeding a summation circuit, which derives a position error signal; and that the pre-amplifier supplies the actuator/transducer output signal to a second input of the summation circuit. The power amplifier may be a switching power amplifier.
The input command signal may be converted to a proportional AC signal before being compared with a position feedback signal, alternatively the actuator/transducer output signal may be converted to a proportional DC signal and compared directly to the input command signal.
The input signals provided to the power amplifier are preferably in the form of a pulse-width modulated representation which may be modified by adding a digital advancing/retarding technique to achieve a synchronous perturbation component.
The error conditioning and conversion circuit may also comprise: a synchronous detector, for demodulating incoming position error information using a synchronous reference signal provided by the said transducer excitation function generator. a servo loop compensation stage, for receiving a signal from the synchronous detector and responding to the DC component thereof by providing the compensation necessary for the desired position control loop characteristic; a converter stage, for converting a compensated DC error signal received from the servo loop compensation stage to a PWM signal, having period T; and a digital modulator for applying advance and retard to the PWM signal received from the converter stage, to produce a modulation having a period 2T.
The power amplifier may also be a linear amplifier and substantially sinusoidal perturbation signals may be employed to energise the actuator transducer assembly.
Preferably the excitation and signal conditioning circuit includes a stage which converts the input command signal to balanced complementary DC reference signals which are proportional in amplitude to the input command signal and a first synchronous demodulator which receives respective signals from the amplifier and also receives a synchronous reference potential and produces DC outputs in proportion to the synchronous component of the AC energising signal in the respective amplifier outputs.
The excitation and signal conditioning circuit may also comprise first summing means for summing the respective outputs of the said first synchronous demodulators with the said balanced complementary DC reference signals to form error signals and compensators for performing control loop compensation on the respective error signals associated with the synchronous perturbation component of the power amplifier output.
In a first and second preferred embodiment of the invention, the transducer excitation function generator and power amplifier are implemented using switching techniques, this offering high efficiency and drive power, and the signal conditioning processes are hybrid--that is they employ mixed analogue and switching technology.
In two further embodiments of the invention, a linear power amplifier is employed and steady state sinusoidal or near sinusoidal transducer excitation is used. In these embodiments much of the signal processing is linear although certain hybrid techniques are utilised. These further embodiments offer the potential for greater precision of performance of the overall system, but lack the benefits of efficiency, compactness and relatively low cost of manufacture of the preferred embodiments.
The invention will be further described by way of these exemplary embodiments and with reference to the accompanying drawings in which:
FIG. 1 is a cross sectional diagrammatic view of a combined linear electric motor and position measurement system with which the present invention can be used;
FIGS. 2a, 2b and 2c show electrical schematic circuits of the system of FIG. 1;
FIG. 3 is an overall block schematic diagram of the electronic system in accordance with the present invention arranged for achieving power drive. position measurement and position control of the motor of FIG. 1;
FIG. 3a is an overall block schematic diagram of a first preferred embodiment of the electronic system in accordance with the present invention employing a switching power amplifier and digitally derived transducer excitation signals.
FIG. 3b is an overall block schematic diagram of a second preferred embodiment of the electronic system in accordance with the present invention employing a switching power amplifier and digitally derived transducer excitation signals.
FIG. 4 is a schematic representation of a switching implementation of the power amplifier of FIGS. 3a and 3b, for providing power drive and transducer excitation for the system of FIG. 1;
FIG. 5 is a timing diagram showing the means for achieving transducer excitation in the electronic systems of FIGS. 3a and 3b by the use of digital modulation of the power amplifier input signal;
FIG. 6a is a block schematic diagram showing the principal sub-systems of the error signal conditioning and converter stage of the embodiment of FIG. 3a;
FIG. 6b is a block schematic diagram showing the principal sub-systems of the error signal conditioning and converter stage of the embodiment of FIG. 3b;
FIG. 7 is a block schematic diagram showing the principal sub-systems of a motor energization and position control system defining a third embodiment of the invention
FIG. 8 is a block schematic diagram showing a motor energization and position control system defining an alternative functional arrangement of the embodiment of FIG. 7.
In the general system block diagram of FIG. 3 an actuator/sensor unit such as that depicted in FIG. 1 is shown being driven by a power amplifier 1. A single ended position signal e.sub.3 and/or differential position signals e.sub.4, e.sub.5 derived from the actuator/sensor unit are fed to a pre amplifier 5 which includes a signal converter circuit. An input signal converter stage 4 produces a proportional version e.sub.6 of the input command signal e.sub.in, and the output of the pre-amplifier and signal converter stage 5, e.sub.8, is subtracted from this. The difference, the position error signal e.sub.7, is fed to a signal conditioning and conversion stage 2. In this stage the position error signal e.sub.7 is demodulated if necessary, compensated. and converted to a signal suitable for feeding to the power amplifier 1. Compensated position error information and synchronous transducer energization are combined in the output of stage 2, the synchronous reference e.sub.ref and digital modulation signals DMOD required in the various embodiments of the invention for this purpose being provided by an excitation function generator stage 3.
FIG. 3a is a block schematic of a first preferred embodiment of the invention, in which an actuator/sensor unit such as that depicted in FIG. 1 is shown being driven by a switching power amplifier 1. Single ended position signals e.sub.3 or differential position signals e.sub.4, e.sub.5 derived from the actuator/sensor unit are fed to the pre amplifier and signal converter stage 5.sub.a. In this first preferred embodiment of the invention, the output of stage 5.sub.a is an AC signal, proportional to the position signal e.sub.3 or to the differential position signals e.sub.4, e.sub.5. It may be a filtered version of these signals as shown by the path P1 comprising a pre amplifier 5.sub.a1 and filter 5.sub.a2, or it may simply be an amplified version of the signals e.sub.3, or e.sub.4, e.sub.5 as shown by path P2 which features only the pre amplifier 5.sub.a1.
In order for the DC position command signal e.sub.in of FIG. 3a to be compared with the position feedback signal e.sub.8a, it is converted to a synchronous AC signal e.sub.6a. This is the function of the input signal converter stage 4.sub.a which performs conversion of e.sub.in to a synchronous AC signal e.sub.6a using reference signal e.sub.ref provided by the excitation function generator 3.sub.a. In stage 4.sub.a, signal chopping or multiplying techniques are employed to produce an AC signal proportional in magnitude to the input e.sub.in and proportional in phase to the sign of e.sub.in. The frequency of the resultant AC position command signal e.sub.6a is equal to that of the position feedback signal e.sub.8a, and the phase. as determined by the synchronous reference e.sub.ref is arranged such that effective differencing of the AC position command signal e.sub.6a and the AC position feedback signal e.sub.8a can be performed by the summation stage 6.sub.a.
The resultant output e.sub.7a of the summation stage 6.sub.a of FIG. 3a is thus a synchronous AC signal expressing in magnitude the degree of position error yielded by the control loop, and in phase, relative to the reference signal e.sub.ref, the sign of the position error. As shown in FIG. 3a, the position error signal is then fed to the signal conditioning and converter stage 2a, the function of which is to demodulate the AC position error signal, to provide a position error signal suitably compensated for achieving closed loop stability in the position control system, to convert this signal to a pulse width modulated (PWM) representation suitable for driving the switching amplifier 1, and finally to modify this PWM representation such as to add a synchronous perturbation component which serves as energization for the position measurement function of the sensor/actuator unit of FIG. 1.
The block diagram of FIG. 6a shows the principal sub-systems of the signal conditioning and conversion stage 2.sub.a and of the input signal convener stage 4.sub.a appropriate to the first preferred embodiment of the invention. Incoming position error information e.sub.7a is demodulated by the synchronous detector 2.sub.a1 using the synchronous reference signal e.sub.ref provided by the transducer excitation function generator 3.sub.a (see FIG. 3), and the resultant signal is fed to the servo loop compensation stage 2.sub.a2. This stage responds to the DC component of the demodulated signal providing the compensation necessary for the desired position control loop characteristic. Following this, the compensated DC error signal is converted to a pulse width modulated (PWM) signal of period T by converter stage 2.sub.a3. This signal in turn feeds digital modulator 2.sub.a4 which applies synchronous advance and retard to the T period PWM signal to produce a 2T period modulation. The necessary digital control signals for this digital modulation, DMOD, are provided by the excitation generator 3.sub.a. In this first preferred embodiment of the invention, the input position command signal e.sub.in is converted to a synchronous AC signal in order for it to be summed with the transducer position signal. This is shown in FIG. 6a where the input signal converter stage 4.sub.a is seen to comprise an input buffer amplifier 4.sub.a1 which feeds a chopper or multiplier stage 4.sub.a2. The chopper stage uses reference signal e.sub.ref to multiply or to chop the input command signal e.sub.in to produce an AC signal e.sub.6a which is proportional in magnitude to e.sub.in, but modulated by e.sub.ref such as to allow effective summation of e.sub.6a with the position feedback signal e.sub.8a at the synchronous frequency 1/2T.
FIG. 3b is a block schematic diagram of a second preferred embodiment of the invention, in which an actuator/sensor unit such as that depicted in FIG. 1 is shown being driven by a switching power amplifier 1. Single ended position signals e.sub.3 or differential position signals e.sub.4, e.sub.5, derived from the actuator/sensor unit are fed to the pre amplifier and signal converter stage 5.sub.b. In this second preferred embodiment of the invention, the output e.sub.8b of stage 5.sub.b is a DC signal proportional in magnitude to the position signal e.sub.3 or to the differential position signals e.sub.4, e.sub.5, and in sign to the relative phase of the position feedback signals to the synchronous reference e.sub.ref. In this configuration, the converted position feedback signal e.sub.8b, being a DC proportional signal, is compared directly to the DC input command signal e.sub.in, avoiding the need to convert the command signal e.sub.in to a synchronous AC signal. This further avoids the requirement to demodulate the error signal e.sub.7b produced by the summer stage 6.sub.b. Thus the input signal converter stage 4.sub.b is simply a DC buffer amplifier which feeds a scaled version e.sub.8b of the DC input command signal e.sub.in to the summer stage 6.sub.b.
The resultant output e.sub.7b of the summer stage 6.sub.b of FIG. 3b is thus a DC signal expressing directly in sign and magnitude the degree of position error yielded by the control loop. As shown in FIG. 3b, the position error signal is then fed to the signal conditioning and converter stage 2.sub.b, the function of which is to provide a position error signal suitably compensated for achieving closed loop stability in the position control system, to convert this signal to a pulse width modulated (PWM) representation suitable for driving the switching amplifier 1 and finally to modify this PWM representation such as to add a synchronous perturbation component which serves as energization for the position measurement function of the sensor/actuator unit of FIG. 1.
The block diagram of FIG. 6b shows the principal sub-systems of the signal conditioning and conversion stage 2.sub.b and of the input signal converter stage 4.sub.b appropriate to the second preferred embodiment of the invention. Incoming DC position error information e.sub.7b is fed to the servo loop compensation stage 2.sub.b1, this stage providing the compensation necessary for the desired position control loop characteristic. Following this, the compensated DC error signal is converted to a pulse width modulated (PWM) signal of period T by converter stage 2.sub.b2. This signal in turn feeds digital modulator 2.sub.b3, which applies synchronous advance and retard to the T period PWM signal to produce a 2T period modulation. The necessary digital control signals for this digital modulation, DMOD, are provided by the excitation generator 3.sub.b. In this second preferred embodiment of the invention, the input position command signal e.sub.in requires no conversion to a synchronous AC signal in order for it to be summed with the transducer position signal. Thus in FIG. 6b input signal converter stage 4.sub.b is seen to comprise only a DC input buffer amplifier 4.sub.b1 which feeds the summer 6.sub.b.
FIG. 5 is a timing diagram, which shows the way in which the above preferred embodiments of the invention employ switch-mode techniques to provide simultaneous power drive and precision transducer excitation for a combined motor and position sensor device such as shown in FIG. 1.
Wave form F.sub.1 in FIG. 5 shows an equal mark/space ratio square wave form such as might be applied to the input of the switching amplifier 1 of FIG. 3. The amplifier shown in diagrammatic form in FIG. 4 acts using power semiconductor devices F1, F2, F3 and F4 to switch the ends of the applied load, in a fashion closely following the switching input wave form e.sub.9, between the applied power rails 0 V, +VE. This achieves minimal dissipation in the amplifier 1 and has the benefit that the amplitude of the amplifier output and the relative times of the switching transitions of the output are well defined and repeatable. The inductance of the load acts to smooth or average the current flowing and the magnitude of any resultant steady DC component is determined by the mean applied voltage divided by the net load circuit resistance. Thus for wave form F.sub.1 of FIG. 5, having an equal mark/space ratio, the average DC load current is zero corresponding to a zero input to the amplifier.
Wave form F.sub.2 of FIG. 5 shows pulse width modulation (PWM) of the amplifier input signal, this being achieved in the embodiment of FIG. 4 by time shifting the rising edge of the wave form, keeping the overall period to T seconds. The average DC value of the voltage applied to the load is now non zero and DC current flows in the load. Wave form F.sub.3 shows PWM modulation, again using the rising edge of the wave form, but this time retarded to reverse the sign of the average current flowing in the load compared to that of wave form F.sub.2. This follows already established principles, and it can be appreciated that PWM modulation can be achieved by modulating either transition of the wave form in a discrete (digital) or continuous (analogue) fashion. Either method would serve to provide DC or quasi static drive current to the motor system of FIG. 1 in proportion to the position error or command signal.
Wave form F.sub.4 shows how digital techniques are employed to achieve synchronous PWM modulation of the amplifier drive wave form and hence well-controlled and synchronised AC excitation for the position measurement function. Here digital modulation techniques are used alternately to advance and retard a given transition of the PWM wave form by a fixed fraction of the PWM period T. This has the effect of alternately offsetting the mean drive voltage applied to the actuator by a constant fraction and at a constant frequency. The period of this applied perturbation is exactly twice that of the pulse width modulation associated with the quasi-static signal and the phase relative to a given rising or falling transition of the reference wave form F.sub.1 is constant. These conditions are ideal for recovery of the transducer signal since the PWM modulation associated with DC or quasi static current is of period T whilst the excitation source for the position measurement, and hence the position information, is conveyed by the magnitude and relative phase of a signal of period 2T. Using synchronous demodulation techniques, the component due to the DC modulation at period T is automatically suppressed, allowing precision recovery of the position information despite the presence of the relatively large higher frequency PWM components.
This is illustrated by further reference to wave form F.sub.7, which is the result of synchronously sampling wave form F.sub.4 with the 2T period function wave form .sub.6. Wave form F.sub.4 carries no DC component, but is digitally modulated with a 2T period perturbation component. Synchronous sampling acts to multiply the wave form by a synchronous reference, in this case wave form F.sub.6, which, given the correct relative phase relationship, acts to demodulate the synchronous component and yield a DC-proportional component in the resultant wave form. In the example of wave form F.sub.7, the resultant has a net positive DC component of fraction 1/8 of the peak amplitude.
Wave form F.sub.8 further shows how the detection method rejects the higher frequency PWM components carrying the DC or quasi-static signal to the system, Here wave form F.sub.5, which carries both 2T period perturbation and T period PWM modulation, is synchronously sampled by wave form F.sub.6, the resultant being wave form F.sub.8. Although more complex, the average is the same as that of wave form F.sub.7, this being contributed solely by the 2T period component of the wave form F.sub.5.
Thus the perturbation or transducer excitation signals are applied using digital techniques to achieve precise, repeatable and highly synchronous position signals, and the DC or power drive signals are applied as additional pulse width modulation using either analogue or digital techniques.
It can be appreciated that suppression of the higher frequency T period PWM components, achieved by the use of synchronous demodulation, is effective for all perturbation functions with periods being a binary multiple of T.
FIG. 7 shows a second embodiment of the invention in which a complementary output linear power amplifier 7.sub.1 is employed to drive the actuator/sensor unit. The amplifier provides quasi static DC output voltage or current to provide power drive to the actuator/sensor unit, and superimposed sinusoidal or near sinusoidal functions for the AC energising signals.
In this embodiment the amplitudes of the AC energising voltages driving the actuator/sensor unit are independently controlled in local closed loop feedback systems. this operating the position sensing system of the actuator/sensor unit in a high precision null balance mode.
Referring to FIG. 7, the outputs e.sub.71, e.sub.72 of amplifier 7.sub.1 drive the actuator sensor unit which is configured either as a half bridge or full bridge circuit producing the corresponding single ended position output signal e.sub.73 or the differential position output signals e.sub.74, e.sub.75. These position output signals are fed to a pre-amplifier stage 7.sub.10 which produces a single ended position output signal e.sub.76.
The amplifier outputs e.sub.7l, e.sub.72, in addition to driving the actuator sensor unit, are also fed to stages 7.sub.3 and 7.sub.4, these being synchronous demodulators which, in conjunction with the synchronous reference potential e.sub.ref, produce DC output signals e.sub.79, e.sub.710 which are in exact proportion to the synchronous component of AC energising signal in the amplifier outputs e.sub.71, e.sub.72. These potentials are summed with reference signals e.sub.715, e.sub.716 which are derived from the position command signal e.sub.in by an input signal converter stage 7.sub.9. The stage 7.sub.9 acts to convert the command signal e.sub.in to balanced complementary DC outputs e.sub.715, e.sub.716 which are proportional in amplitude to e.sub.in but of opposite sign and superimposed on a constant component of voltage. Signals e.sub.711, e.sub.7l2 are the error signals or the deviations of potentials e.sub.79 e.sub.710 from the commanded values derived from e.sub.in. These error signals are fed to stages 7.sub.5, 7.sub.6 which perform control loop compensation to achieve the desired response of amplitude control of the AC energising component of signals e.sub.71, e.sub.72 Following compensation, the outputs of stages 7.sub.5, 7.sub.6 are fed to voltage controlled function generators 7.sub.7, 7.sub.8 which produce sinusoidal or near sinusoidal output voltages e.sub.713, e.sub.714 which are synchronous with the switching reference e.sub.ref and proportional in amplitude to the outputs of the compensation stages 7.sub.5, 7.sub.6. The outputs of function generators 7.sub.7, 7.sub.8 are summed into the inputs of amplifier 7.sub.1 to complete the closed loops in which the AC energising components of the actuator sensor drive potentials e.sub.7l, e.sub.72 are controlled.
The AC energization component of the actuator sensor potentials are thus anti phase sinusoidal or near sinusoidal functions which are controlled to vary in amplitude in a complementary fashion, in proportion to the magnitude and sign of the control system input command signal e.sub.in. In order to provide for position sensing and control in mid range when e.sub.in is zero, an offset or constant magnitude component is added to the energising potentials. As mentioned above this component is introduced by an input converter stage 7.sub.9 in FIG. 7.
Returning to FIG. 7. It will now be evident that the signal e.sub.76 appearing at the output of pre amplifier 7.sub.10 is a position error signal. The controlled amplitude AC energising potentials produced by the local control loops described above are summed by the inductive bridge circuit of the actuator unit and, given that the relative imbalance of the energising potentials corresponds to the relative imbalance of the actuator bridge inductances (brought about by movement of the actuator), then the position output signal e.sub.73 or e.sub.74, e.sub.75 from the sensor/actuator is of null amplitude.
To implement closed loop position control of the actuator sensor unit the pre amplified null error signal e.sub.76 is fed to a synchronous demodulator stage 7.sub.11. Using the synchronous reference e.sub.ref this stage produces a DC output e.sub.77 which is proportional in magnitude and sign to the AC error signal e.sub.76. This in turn feeds control loop compensation stage 7.sub.12 which acts on the error signal e.sub.77 to provide the desired response characteristics for the overall servo position control function. The position control loop is completed by splitting the compensated position error signal e.sub.78 into complementary outputs via amplifiers 7.sub.13, 7.sub.14 and summing these signals with the AC energising inputs e.sub.713, e.sub.714 into the power amplifier 7.sub.1.
The benefit of the null balance control loop described above is that for all output positions of the actuator unit according with the commanded position represented by signal e.sub.in, the position output signals e.sub.73 or e.sub.74, e.sub.75 produced by the actuator unit are null. This means that precision of signal processing in the position control loop is not required.
FIG. 8 shows a third embodiment of the invention which is a modification of the configuration depicted in FIG. 7. In this embodiment the AC energising voltages driving the actuator/sensor unit are maintained at constant amplitude with the result that the feedback signals from the sensor portion of the unit correspond to absolute position and not to position error as in the system of FIG. 7 described above. This arrangement has the benefit of reduced overall complexity and hence cost, but lacks the precision of operation attainable from the system of FIG. 7.
Referring to FIG. 8, the outputs of amplifier 8.sub.1 drive the actuator/sensor unit producing a single ended position output signal e.sub.83 or differential position output signals e.sub.84, e.sub.85. These position signals are fed to a pre amplifier stage 8.sub.10 which in turn feeds a demodulator stage 8.sub.11. The demodulator stage, using the synchronous reference signal e.sub.ref converts the AC position feedback signal e.sub.86 to a DC signal e.sub.87, the magnitude of which is proportional to e.sub.86, and the sign being determined by the phase of e.sub.86 relative to that of the reference e.sub.ref. To achieve position control, the demodulated position feedback signal e.sub.87 is compared with a buffered version e.sub.88 of input command signal e.sub.in by the summation stage 8.sub.5. The resultant position error signal e.sub.89 is fed to the stage 8.sub.6 which provides the necessary compensation of the error signal for the required overall position control loop response. This compensated error signal e.sub.810 then feeds the power amplifier via an additional summer and driver stages 8.sub.7, 8.sub.8 and 8.sub.9. The additional summer stage 8.sub.7 finctions to allow injection of the transducer excitation unction e.sub.811 into the power amplifier 8.sub.1. This is a periodic sinusoidal or near sinusoidal function produced by stage 8.sub.4. This function emerges from stage 8.sub.7 summed with, and hence superimposed upon the position error signal e.sub.810. This composite signal e.sub.815 is converted to balanced antiphase signals by the stages 8.sub.8, 8.sub.9 where it drives the inputs of the power amplifier 8.sub.1. The outputs of this amplifier e.sub.81, e.sub.82 thus contain balanced or differential drive components of both the power actuation and transducer energization signals required by the actuator/sensor unit. The function of the energization control loop described here is to stabilise the amplitudes of the transducer energization component of the actuator/sensor drive signals to a degree adequate for the required position accuracy and repeatability. To achieve this, the outputs e.sub.81, e.sub.82 of the amplifier 8.sub.1 are fed to stage 8.sub.2 which performs demodulation of the perturbation component of e.sub.81, e.sub.82 using the synchronous reference signal e.sub.ref. The stage 8.sub.2 responds to the difference of signals e.sub.81, e.sub.82 thus ensuring that the overall amplitude of the energization applied to the actuator/sensor unit is taken into account. The output e.sub.812 of stage 8.sub.2 is a DC signal proportional in magnitude to the synchronous component of the difference between e.sub.81 and e.sub.82 which is compared with a DC reference potential Vref in the summer stage 8.sub.13. The resultant error signal e.sub.813 feeds stage 8.sub.3 which provides the compensation required to achieve the desired response characteristic of the excitation signal stabilisation loop. The compensated DC output, e.sub.184 then feeds the function generator stage 8.sub.4. This stage, using the synchronous reference signal, e.sub.ref ; produces a sinusoidal output wave-form approximately proportional in amplitude to the compensated DC input e.sub.814 and controlled in phase, or synchronous with the reference e.sub.ref.
Claims
- 1. A position control and monitoring circuitry for an electric motor having a plurality of coils and a movable element, comprising:
- drive means generating a square wave drive signal of variable mark/space ratio to drive the coils to position the movable element, the square wave drive signal having a drive signal frequency;
- monitoring means for modulating square wave transitions at a sub-harmonic of the drive signal frequency to generate a monitoring signal for supply to the coils;
- sensing means for sensing the monitoring signal from the coils to thereby determine the position of the movable element; and
- difference means for driving the drive means with a difference between an input signal and an output signal of the sensing means.
- 2. A circuitry according to claim 1, wherein the monitoring means modulates the square wave transitions at half of the drive signal frequency.
- 3. A circuitry according to claim 1, wherein the square wave transitions are, in a first sense, modulated by the drive means, and the square wave transitions are, in a second sense opposite to the first sense, modulated by the monitoring means.
- 4. A circuitry according to claim 2, wherein the square wave transitions are, in a first sense, modulated by the drive means, and the square wave transitions are, in a second sense opposite to the first sense, modulated by the monitoring means.
- 5. A position control and monitoring method for control and monitoring an electric motor having a plurality of coils and a movable element, comprising the steps of:
- with a drive circuit, generating a square wave drive signal of variable mark/space ratio to drive the coils to position the movable element, the square wave drive signal having a drive signal frequency;
- modulating square wave transitions at a sub-harmonic of the drive signal frequency to generate a monitoring signal for supply to the coils;
- sensing the monitoring signal from the coils to thereby determine the position of the movable element; and
- driving the drive circuit with a difference between an input signal and an output signal of the sensing step.
- 6. A method according to claim 5, wherein the step of modulating the square wave transitions is performed with a sub-harmonic having half of the drive signal frequency.
- 7. A method according to claim 5, wherein the step of modulating is performed by modulating the square wave transitions in a first sense by the drive circuit, and by modulating the square wave transitions in a second sense opposite to the first sense by the monitoring signal.
- 8. A method according to claim 6, wherein the step of modulating is performed by modulating the square wave transitions in a first sense by the drive circuit and by modulating the square wave transitions in a second sense opposite to the first sense by the monitoring signal.
Priority Claims (1)
Number |
Date |
Country |
Kind |
9519620 |
Sep 1995 |
GBX |
|
PCT Information
Filing Document |
Filing Date |
Country |
Kind |
102e Date |
371c Date |
PCT/GB96/02356 |
9/23/1996 |
|
|
3/17/1998 |
3/17/1998 |
Publishing Document |
Publishing Date |
Country |
Kind |
WO97/12305 |
4/3/1997 |
|
|
Foreign Referenced Citations (9)
Number |
Date |
Country |
0 295 710 |
Dec 1988 |
EPX |
0 457 389 |
Nov 1991 |
EPX |
0 515 974 |
Dec 1992 |
EPX |
0 602 977 |
Jun 1994 |
EPX |
1-381 125 |
Jan 1975 |
GBX |
2 088 589 |
Jun 1982 |
GBX |
2 134 731 |
Aug 1984 |
GBX |
2 142 452 |
Jan 1985 |
GBX |
95 08214 |
Mar 1995 |
WOX |