Resonant frequency tracking and control
11325154 · 2022-05-10
Assignee
Inventors
Cpc classification
B06B1/045
PERFORMING OPERATIONS; TRANSPORTING
G06F3/016
PHYSICS
B06B1/0253
PERFORMING OPERATIONS; TRANSPORTING
International classification
B06B1/02
PERFORMING OPERATIONS; TRANSPORTING
Abstract
For a resonator system such as a (haptic) LRA, a methodology for resonant frequency (F0) tracking/control with continuous resonator drive, based on estimating back-emf, including estimating resonator resistance based at least in part on the sensed resonator drive signals, with back-emf estimated based at least in part on the sensed resonator drive signals and the estimated resonator resistance. A phase difference is detected between the resonator drive signals, and the estimated back-emf signals, generating control for resonator drive frequency, which can be used to iteratively adjust the resonator drive frequency until phase coherent with the estimated back-emf signals (F0 lock), such as for driving the resonator at or near a resonant frequency. An amplitude control loop can be used to iteratively adjust resonator drive amplitude based on a difference between estimated back-emf and a target back-emf derived from a rated back-emf and the resonator frequency resonant frequency.
Claims
1. A circuit for determining a frequency for driving a resonator, comprising: resonator drive circuitry having a first input, a second input and an output wherein the first input is coupled to an amplitude control signal and the second input is coupled to a frequency control signal; an amplifier having an input and an output wherein the input is coupled to the output of the resonator drive circuitry and the output of the amplifier is directly coupled to an output of the circuit for driving a resonator, where the output of the circuit for driving a resonator is configured to drive a resonator; sense circuitry having an input, first output and a second output wherein the sense circuit input is directly coupled to the output of the amplifier, wherein the sense circuitry determines the voltage and current at the output of the amplifier; a frequency tracker/controller having a first input, a second input, a first output, a second output and a third output wherein the first input is coupled to the first output of the sense circuitry, the second input is coupled to the second output of the sense circuitry and the first output is coupled to the first input of the resonator drive circuitry; and an amplitude control circuitry having a first input, a second input, a third input and an output wherein the first input is coupled to the output of the amplifier, the second input is coupled to the second output of the frequency tracker/controller, the third input is coupled to the third output of the frequency tracker/controller and the output of the amplitude control circuit is coupled to the second input of the resonator drive circuitry; wherein the circuit determines a frequency for driving a resonator; wherein the frequency tracker/controller further comprises back-emf estimation circuitry which estimates back-emf and generates an estimated back-emf signal based on a sensed resonator drive current and sensed resonator drive voltage generated from the first and second outputs of the sense circuitry respectively; wherein the frequency tracker/controller further comprises a resonator resistance circuitry wherein the resonator resistance estimates resonator resistance based on the sensed resonator current signal that is sensed within a defined number of cycles of the estimated back-emf signal; wherein the resonator resistance circuitry further comprises: resistance estimation circuitry to estimate resonator resistance; and resistance adjustment circuitry to adjust the estimated resonator resistance based on an estimated phase difference; and the back-emf estimation circuitry is configured to estimate back-emf at least in part based on the adjusted estimated resonator resistance; and wherein the amplitude control circuitry iteratively adjusts the amplitude of a resonator drive signal generated from the output of the amplitude control circuitry based on a difference between an estimated back-emf signal and a target back-emf signal derived from a rated back-emf and a resonant frequency FO.
2. The circuit of claim 1, wherein the frequency tracker/controller generates a frequency control signal for the first input of the resonator drive circuitry to iteratively adjust the frequency of the output of the resonator drive circuitry until the frequency of the output of the circuit is near a resonant frequency (FO).
3. The circuit of claim 1, wherein the sensed circuitry generates on the first output of the sensed circuitry a drive signal based on a sensed resonator current signal.
4. The circuit of claim 1 wherein the frequency tracker/controller further comprises a phase difference circuitry wherein the phase difference circuitry estimates phase difference by identifying back-emf zero crossing and/or back-emf peak crossing when sensed resonator drive current is above a defined current threshold.
5. The circuit of claim 1 wherein the resonator drive signal is one of a resonator drive current or a resonator drive voltage; and the sense circuitry is configured to sense a resonator current for a resonator drive voltage, or to sense a resonator voltage for a resonator drive current.
6. The circuit of claim 1 wherein the circuit drives a linear resonant actuator.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
(1)
(2)
(3)
(4)
(5)
(6)
(7)
(8)
DETAILED DESCRIPTION
(9) This Description and the Drawings constitute a Disclosure, including design examples and implementations, and including illustrating various technical features and advantages for: Resonant frequency (F0) tracking/control with continuous resonator drive (V or I), based on estimating back-emf (including estimating resonator resistance) from sensed resonator drive (I or V), iteratively adjusting resonator drive frequency until it is phase coherent with estimated back-emf (F0 lock).
(10) This Disclosure uses the following nomenclature. A resonator operates based on resonator drive signals at a resonator drive frequency (including operation at or near a resonant frequency F0 for the resonator). The resonator is driven continuously based on either resonator drive voltage (V) signals, or resonator drive current (I) signals. Continuous resonator drive means resonator drive without a separate sense mode for determining back emf. Back-emf is sometimes referenced as BEMF. Rated BEMF means the nominal back-emf voltage BEMFnom that provides a rated vibration at a nominal resonant frequency F0nom. Target BEMF means the back-emf voltage for the given LRA resonant frequency F0 which will provide the same rated vibration as an LRA with BEMFnom at F0nom. Target BEMF is generated by an amplitude/voltage control loop as a variable function of Rated BEMF and the resonant frequency F0 which is generated by an F0 tracking/control loop.
(11) In brief overview, for a resonator system such as a (haptic) LRA, resonant frequency (F0) tracking/control with continuous resonator drive, is based on estimating back-emf, including estimating resonator resistance based at least in part on the sensed resonator drive signals, with back-emf estimated based at least in part on the sensed resonator drive signals and the estimated resonator resistance. A phase difference is detected between the resonator drive signals, and the estimated back-emf signals, generating control for resonator drive frequency, which can be used to iteratively adjust the resonator drive frequency until phase coherent with the estimated back-emf signals (F0 lock), such as for driving the resonator at or near a resonant frequency. An amplitude control loop can be used to iteratively adjust resonator drive amplitude based on a difference between estimated back-emf and a target back-emf derived from a rated back-emf and the resonator frequency resonant frequency.
(12) In an example design, a resonator drive voltage is input to an amplifier. The amplifier drives a voltage across the resonator resulting in a resonator drive current which causes the resonator to vibrate. The F0 control loop uses sensed resonator drive current (Is) and either resonator drive voltage (V) or sensed resonator drive voltage (Vs) to estimate resonator resistance (Re), and to estimate back-emf based on resonator drive, sensed resonator drive current (Is) and resonator drive voltage (either V or Vs), and estimated Re: BEMF=V−Is*Re or BEMF=Vs−Is*Re. The estimated phase difference between the resonator drive voltage and the Estimated BEMF is used to iteratively adjust the frequency of the resonator drive voltage until it is phase coherent with Estimated BEMF (F0 lock). The example design includes an amplitude/voltage control loop to adjust resonator drive voltage based generating a Target BEMF as a variable function of Rated BEMF and the resonant frequency (F0).
(13) For each frequency adjustment iteration, resonator resistance can be estimated in the initial (first or first few) BEMF voltage cycle(s), where the sensed current is dominated by the contribution from resonator resistance, or alternately estimated by inserting a low frequency, low amplitude pilot tone.
(14) Phase difference can be estimated based on BEMF peaks and/or zero crossings. The accuracy of determining BEMF peaks and zero crossing depends on the accuracy of the resonator current sensor, which depends on the sense signal level. Hence, either peaks or zero crossing (or both) can be used depending on whether the resonator current signal level is above a design threshold level for a peak region, or a zero crossing region, or both. For example, zero crossings can be used for estimating relatively large phase difference where the resonator current sense signal is above the design threshold for regions of BEMF zero crossings, peak crossings can be used for estimating relative small phase difference where the resonator current sense signal is above the design threshold for regions of BEMF peak crossing, and both zero and peak crossings can be used for estimating mid-range phase difference where the resonator current sense signal is above the design threshold for regions of both BEMF zero and peak crossing.
(15) An amplitude/voltage control loop can be used to adjust resonator drive amplitude/voltage (for example, to provide uniform haptic feedback) based on determining a target back-emf, as a variable function of rated back-emf and resonator frequency, and generating an amplitude control signal as a difference (error) between target back-emf and estimated back-emf.
(16) Resonator drive can be voltage drive, with the F0 tracking/control loop using sensed resonator current Is and drive voltage V or sensed resonator drive voltage Vs. Alternately, resonator drive can be current drive, with the F0 tracking/control loop using sensed resonator voltage Vs and drive current I or sense resonator current Is.
(17) An example application is an LRA (linear resonant actuator), such as to provide haptic feedback. In addition to LRA resonant frequency tracking/control, resonator drive amplitude tracking/control can be used to normalize drive voltage for constant vibration and acceleration to provide uniform haptic feedback, using a target back-emf which is derived from the rated back-emf and the resonant frequency. For the example LRA application, the Target BEMF can be selected to provide a constant haptic acceleration and vibration.
(18) In example designs, resonant frequency tracking/control based on estimating back-emf (including estimating resonator resistance) according to the Disclosure can be implemented as a fully integrated resonator driver (driving an external resonator, such as an LRA), including sensing, and with dedicated resonant frequency tracking/control (which can be implemented with one or more programmable components). Alternately, in other example designs, the resonator driver circuit, including sensing circuitry, can be integrated with a DSP (and ADC/DAC interface) to implement resonant frequency tracking/control based on estimating back-emf (including estimating resonator resistance). Alternately, in other example designs, a resonator driver controller can be implemented in a DSP or other programmable device, configured for interface to an external resonator driver including sensing, and configured to implement resonator frequency tracking/control based on estimating back-emf (including estimating resonator resistance).
(19)
(20) LRA drive electronics 20 includes a resonator driver 21 providing a continuous resonator drive voltage 22, coupled to an amplifier 28 which is used to drive the resonator LRA 30. The example LRA/resonator is continuously driven with an adjusted resonator voltage (V). Resonator drive sensor circuitry 120, coupled to the resonator drive output 29 of amplifier 28, senses resonator drive current.
(21) LRA drive electronics 20 includes an adaptive F0 and amplitude tracking/control loop 101, based on estimating back-emf (including estimating resonator resistance) from sensed current Is and either voltage drive V or sensed resonator voltage Vs. Estimated BEMF is used to estimate the phase difference between resonator drive, and Estimated BEMF, iteratively adjusting resonator drive frequency until it is phase coherent with Estimated BEMF (F0 lock). The F0 tracking/control loop, based on estimating back emf, avoids switching between drive and sense modes, where back-emf is sensed (rather than estimated). Effectively, the natural response of the LRA is implicitly derived, instead of being explicitly sensed (using a dedicated back-emf sense mode).
(22) As described in connection with
(23) The F0 and amplitude tracking/control loop 101 includes a resonator frequency tracking/control block 110 (frequency tracker/controller), and a resonator drive sensor 120. The example LRA drive electronics 20 provides resonator voltage drive 22 to the amplifier 28 to drive the LRA 30. The drive voltage results in resonator current to flow through the LRA and produce vibration by inter-acting with the magnetic field inside the LRA.
(24) The example resonator drive sensor 120 is coupled to the output 29 of amplifier 28, and senses resonator drive current with a current sensor 121, to generate a (feedback) sensed resonator current signal 129I to the frequency tracker/controller 110. Resonator drive sensor 120 also generates a resonator drive voltage signal 129V, which can be the resonator drive voltage 22V (input to amplifier 28) or a sensed resonator drive voltage signal from the output 29 of amplifier 28. Filtering 123 can be used to remove noise, and time-align the current sense signal 129I with resonator drive voltage 129V, and improve SNR (correct determination of peaks and zero-crossings depends on a clean LRA current-sense signal). Similar filtering can also be applied to the resonator drive voltage 129V (feedback or sensed).
(25) The example frequency tracking/control block 110 includes a back-emf estimation block 130, including resonator resistance (Re) estimation block 140, a phase difference detector block 150, a resonator frequency control block 160. Back-emf estimation block 130 includes a back-emf estimator 131. Resonator resistance (Re) estimation block 140 includes an Re estimator 141, and an Re auto-correct/adjuster 143.
(26) The frequency tracker/controller 110 receives, through the back-emf estimation block 130, the sensed resonator current signal 129I, which is input to the back-emf estimator 131, and to the Re estimator 141. Re estimator 141 also receives from resonator drive sensor 120 the resonator drive voltage signal 129V (feedback V or sensed Vs), and generates an estimated Re signal 149.
(27) The example resonator resistance (Re) estimation block 140 includes an adaptive Re adjust block to auto-correct the phase misalignment by adjusting estimated Re based on a (feedback) phase difference measurement (discussed further in connection with
(28) Back-emf estimator 131 receives the (feedback) resonator drive voltage (V input) or sensed (filtered) LRA drive voltage (Vs input) 129V, the (feedback) sensed resonator current signal 129I (Is input), and the adjusted estimated Re, and generates an Estimated BEMF signal 139 (Back-EMF=V−Is*Re or Back-EMF=Vs−Is*Re).
(29) Phase difference detector block 150 receives the resonator voltage signal 129V (feedback or sensed), and the Estimated BEMF signal 139, and determines the phase difference between resonator drive voltage, and Estimated BEMF, and provides a phase difference signal 159.
(30) Resonator frequency control block 160 receives the phase difference signal 159, and provides a (feedback) resonator frequency control signal 169 to the resonator driver 21. Phase difference can be estimated using a zero/peak crossing technique described in connection with
(31) In response to the resonator frequency control signal 169, the resonator driver 21 iteratively adjusts resonator drive frequency of the resonator drive voltage until it is phase coherent with Estimated BEMF, providing F0 lock. The example adaptive F0 tracking/control loop can use a pre-characterized LRA model as an initial condition for iteration.
(32)
(33) A voltage control loop can be used to alter drive voltage based on a Rated BEMF and the resonant frequency, ensuring that acceleration, and vibration, feedback are constant. Vibration can be normalized to provide uniform haptic feedback, using a target back emf which is derived from the Rated BEMF and the resonant frequency. The Estimated BEMF signal is subtracted from the Target BEMF and the difference signal (error) is multiplied using a gain block and the output of the gain block is used to adjust the amplitude of the voltage drive. The voltage control loop ensures that at steady state the error is zero (or close to zero).
(34)
(35) For example designs, the F0 loop operates first to achieve F0 lock, iteratively adjusting resonator drive frequency until it is phase coherent with BEMF. Then, after F0 lock, the amplitude loop operates to generate Target BEMF (from Rated BEMF and the resonant frequency F0), iteratively adjusting resonator drive amplitude based on estimated BEMF (from the F0 loop), and generated Target BEMF (from the amplitude loop). Alternately, the F0 loop and amplitude loop can operate independently, with Target BEMF generated based on Rated BEMF and feedback resonator frequency (from the F0 loop, independent of F0 lock).
(36) An example amplitude control block 210 includes a target back-emf computation block 211, to generate Target BEMF 212 based on Rated BEMF 214 (such as a register value) and the resonant frequency F0. The amplitude control/update block 210 generates the amplitude control signal 219 based on a difference (error) 216 between the Estimated BEMF 239, and the Target BEMF 212.
(37) A gain block 218 provides the amplitude control signal 219 [gain×error(Estimated BEMF−Target BEMF)]. Gain block 218 receives an F0 lock flag 169flg from the F0 loop (resonator frequency control block 160) to indicate when the F0 loop has achieved F0 lock, and then outputs the amplitude control signal 219 to the resonator driver 21.
(38)
(39)
(40)
(41)
(42)
(43) In summary, for the example resonant frequency tracking/control architecture of
(44) Drive the LRA at the rated voltage with a sinusoid at a defined frequency F0_int and amplitude. For example, the pre-defined frequency can be based on characterized data of a sample LRA and the amplitude can be the rated voltage of a sample LRA.
(45) Sense LRA drive current and (optionally) LRA drive voltage, for example from a sensing circuit in the amplifier.
(46) Filter the current-sense to remove noise and time-align the current-sense with input voltage. The input voltage can be the drive voltage (V) or the sensed LRA drive voltage (Vs). Similar filtering may also be applied to the drive voltage (V) or the sensed LRA drive voltage (Vs).
(47) Estimate the resistance of the LRA by doing a V/I estimate in the first voltage cycle (or first few voltage cycles).
(48)
Alternatively, the resistance of the LRA can be estimated by inserting a low frequency, low amplitude pilot tone.
(49) Estimate Back-EMF, V.sub.BEMF_est=V−I×R.sub.e_est
(50) Sample the Back-EMF only when the sense-current is above a threshold (current-sensing can be inaccurate when the current flowing through the LRA is below a design threshold).
(51) Determine the time position of the sampled Back-EMF corresponding to: (a) Zero-crossing—when the phase difference between F0 and F0_init is relatively large (because the current-sensing signal is above the design threshold at regions of zero-crossing); (b) Peak-crossing—when the phase difference between F0 and F0_init is relatively small (because the current-sensing signal is above the design threshold at regions of peak-crossing); and (c) Both zero-crossing and peak-crossing are detected when the phase difference between F0 and F0_init is mid-range (because the current-sensing signal is above the design threshold at regions of both zero-crossing and peak-crossing)
(52) Measure the phase difference between zero/peak-crossing of Back-EMF and input voltage, Φ=V(crossing)−V.sub.BEMf(crossing)
(53) Adjust R.sub.e_est if there is mis-alignment in Φ
(54) Else, Update the F0 estimate based on the following updated equation:
(55)
where Q.sub.ts=mechanical Q factor of the LRA and is estimated based on a pre-characterized model of a sample LRA.
(56) Drive the LRA at the rated voltage with the sinusoid frequency updated to F0(n).
(57) Derive a Target BEMF based on a Rated BEMF and F0. Calculate the difference between the Target BEMF and the Estimated BEMF (error) and multiply the error signal with a gain (error×gain), and adjust the amplitude of the input voltage based on the error signal.
(58) The F0 tracking/control operations in [0049-59] are performed in the F0 tracking/control loop (
(59)
(60) When an LRA/resonator is excited at or near the resonance frequency, the back-emf build up takes some time due to mechanical inertia. So, in the first few cycles, the current in the LRA circuit is dominated by the contribution from Re. Subsequently, as back-emf increases, the LRA drive current (sensed Is) decreases and settles to a lower value due to the additional contribution from the LRA back-emf.
(61) So, for the example LRA F0 and amplitude tracking/control architecture, dc resistance of the LRA can be estimated by measuring V/I in the first few cycles, according to:
(62)
with a summation of V×I and I×I measurements used to filter out any reactive leakage component in the circuit. Alternatively, the dc resistance (=V/I) can also be measured using
(63)
if there is none or negligible contribution from any reactive circuit. Alternatively the dc resistance can also be measured by inserting a low frequency, low amplitude pilot tone. Since the pilot tone frequency is very low (close to DC), the measurement of dc resistance based on the low frequency component of V and I is very accurate and very close to the dc resistance value.
(64)
(65)
(66) V.sub.BEMF=Actual Back-EMF
(67) V.sub.BEMF_est=Estimated Back-EMF
(68) Re=Actual Resistance
(69) Re_est=Estimated Resistance
(70) V=Drive Voltage
(71)
is the “reflection” of the input voltage due to incorrect R.sub.e estimation
(72) When Re_est>Re, the phase of V.sub.BEMF_est gets reversed due to negative sign of
(73)
(74) To correct the phase misalignment, Re_est can be decreased (auto-corrected) until the measured phase satisfies the valid phase conditions. The adaptive Re auto-correction is able to improve the Re measurement accuracy and eliminate the phase error.
(75)
(76)
(77) Table 1 provides relationships between phase difference and peak/zero crossing, where: (a) Phase difference between back-emf and drive voltage is between −π/2 and π/2; and (b) Measured phase difference can be used to determine the accuracy of back-emf estimation, and to provide auto-correction of R.sub.e_est. Different phase conditions are:
(78) TABLE-US-00001 Phase Back-EMF Voltage condition Zero-crossing, +ve to −ve +ve Half cycle, 1.sup.st quarter Auto (Q1) correction required Zero-crossing, +ve to −ve +ve Half cycle, 2.sup.nd quarter OK (Q2) Zero-crossing, +ve to −ve −ve Half cycle, 1.sup.st quarter OK (Q3) Zero-crossing, +ve to −ve −ve Half cycle, 2.sup.nd quarter Auto (Q4) correction required Zero-crossing, −ve to +ve +ve Half cycle, 1.sup.st quarter OK (Q1) Zero-crossing, −ve to +ve +ve Half cycle, 2.sup.nd quarter Auto (Q2) correction required Zero-crossing, −ve to +ve −ve Half cycle, 1.sup.st quarter Auto (Q3) correction required Zero-crossing, −ve to +ve −ve Half cycle, 2.sup.nd quarter OK (Q4) Peak-crossing, +ve +ve Half cycle (H1) OK Peak-crossing, +ve −ve Half cycle (H2) Auto correction required Peak-crossing, −ve +ve Half cycle (H1) Auto correction required Peak-crossing, −ve −ve Half cycle (H2) OK
(79)
(80) Note that these figures are just illustrations of how BEMF peak and/or zero-crossing can be used to measure phase, based on resonator drive current relative to current thresholds (positive/negative). For example, the phase detector can be activated as soon as the resonator current sensor signal exceeds the current thresholds. Once the detector is activated, it looks for both peak and zero crossing events. In examples such as 7B it will only register the zero crossing event. In 7C it will register both zero and peak crossing events. In 7D it will register only peak crossing events.
(81) The transfer function of back-emf to input voltage is:
(82)
(83) Mms=Moving Mass
(84) Cms=Compliance=1/Spring Constant
(85) Rms=Damping Factor
(86) Bl=Force Factor
(87) Re=dc resistance of the LRA coil
(88) ω.sub.0=Resonance frequency
(89) Q.sub.ts=Mechanical Q-factor
(90)
(91) By measuring the phase difference between the peak/zero-crossing of the LRA back-emf and the LRA drive voltage, and knowing the frequency of the LRA drive voltage (ω), ω.sub.0 (i.e. f.sub.0) can be iteratively tracked until it is phase coherent with Estimated BEMF, achieving F0 lock. For example, if the phase difference is positive, then the frequency of the drive voltage is less than f.sub.0, so the drive frequency has to be increased, and if the phase difference is negative, then the frequency of the drive voltage is greater than F0, so the drive frequency has to be decreased.
(92) An alternate method for iteratively updating F0 is:
(93)
At every back-emf peak or every back-emf zero-crossing (i.e. every half cycle), F0 is updated based on equation (i), which converges to F0 lock. This alternate update methodology converges very fast to the final solution. The update equation depends on Qts which is initialized based on a pre-characterized sample LRA. Convergence and accuracy of the alternate update methodology is robust to Qts variations.
(94)
(95) Test LRA Specs:
(96) Mms=0.1 gm
(97) Cms= 1/120 m/N
(98) Rms=0.006 N−s/m
(99) Bl=0.1 Tm
(100) Re=26.7Ω
(101) F0=174.4 Hz.
(102) Qts=17.18
(103) Peak Back-EMF=1.667Ω
(104) Drive Voltage=2 Vrms sinusoid
(105)
(106) Advantages of the resonant frequency and amplitude tracking/control architecture including adaptive F0 tracking/control loop based on Estimated BEMF include: Continuous resonator drive enables optimizing efficiency and acceleration; Resonator drive amplitude can be normalized, for example to normalize LRA vibration to provide uniform haptic feedback; Mechanical noise is minimized because there is no ON-OFF switching of the drive voltage (between drive and sense modes).
(107) The Disclosure provided by this Description and the Figures sets forth example designs and applications illustrating aspects and features of the invention, and does not limit the scope of the invention, which is defined by the claims. Known circuits, connections, functions and operations are not described in detail to avoid obscuring the principles and features of the Disclosed example designs and applications. This Disclosure can be used by ordinarily skilled artisans as a basis for modifications, substitutions and alternatives, including adaptations for other applications.