# US 11,121,662 B2 · Closed loop resonance tracking using phase matching

> Agents: this data is available as JSON from the patentgrep API and MCP server — see https://patentgrep.com/llms.txt

- Number: US 11,121,662 B2
- Document ID: US11121662B2
- Status: Granted
- Kind: B2
- Application number: 16/856,490
- Filed: 2020-04-23
- Published: 2020-12-10
- Granted: 2021-09-14
- Earliest claimed: 2019-06-05
- Assignees: Texas Instruments Incorporated
- Applicants: Texas Instruments Incorporated
- Inventors: Supriyo Palit; David Hernandez
- Web page: https://patentgrep.com/patent/US11121662B2

## CPC

- H02P 25/06: Linear motors
- H02P 25/034: Voice coil motors (voice coil motors driven by DC H02P7/025)
- H02P: CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS

## Abstract

Disclosed embodiments include a method for closed loop phase tracking comprised of determining a first estimated resonant frequency, generating a motor drive signal at the first estimated resonant frequency and applying the motor drive signal to a motor, measuring current and voltage of the motor drive signal, and filtering the measurements of current and voltage of the motor drive signal. The phase difference between the filtered current and voltage waveforms is measured and a second estimated resonant frequency is calculated. The generated motor drive frequency is adjusted to equal the second estimated resonant frequency.

## Claims

### Claim 1

A method for closed loop phase tracking comprised of:
determining a first estimated resonant frequency;
generating a motor drive signal at the first estimated resonant frequency and applying the motor drive signal to a motor;
measuring current and voltage of the motor drive signal;
filtering the measurements of current and voltage;
measuring the phase difference between the filtered current and voltage; and
calculating a second estimated resonant frequency and adjusting the generated motor drive frequency to equal the second estimated resonant frequency.

### Claim 2 (depends on 1)

The method of claim 1, wherein if an absolute value of the measured phase difference is less than a first threshold, the second estimated resonant frequency remains the same as the first estimated resonant frequency.

### Claim 3 (depends on 1)

The method of claim 1, wherein if an absolute value of the measured phase difference is greater than a first threshold, the second estimated resonant frequency is equal to the first estimated resonant frequency increased or decreased by an incremental value.

### Claim 4 (depends on 1)

The method of claim 1, wherein if an absolute value of the measured phase difference is greater than a first threshold, the second estimated resonant frequency is equal to the first estimated resonant frequency increased or decreased by a calculated amount that is a function of the measured phase difference and a mechanical quality factor that is a function of a mass of an object being moved and a spring constant of a spring attached to the object.

### Claim 5 (depends on 4)

The method of claim 4, wherein the second estimated resonant frequency is higher than the first estimated resonant frequency if the measured phase difference is negative.

### Claim 6 (depends on 1)

The method of claim 1, wherein the current and voltage measurements are filtered by a noise filter and a phase compensation filter.

### Claim 7 (depends on 6)

The method of claim 6, wherein only the current measurements are filtered by the phase compensation filter.

### Claim 8 (depends on 6)

The method of claim 6, wherein only the voltage measurements are filtered by the phase compensation filter.

### Claim 9 (depends on 6)

The method of claim 6, wherein the noise filter is a bandpass filter.

### Claim 10 (depends on 6)

The method of claim 6, wherein the noise filter is a low pass filter.

### Claim 11

An apparatus for closed loop control of a linear resonant actuator comprising:
a motor drive circuit that generates a motor drive signal having a frequency of a first resonant frequency and configured to provide the motor drive signal to a motor;
a current and voltage sensing circuit configured to couple to a motor and measure current and voltage from the motor drive signal;
a noise filter circuit coupled to the current and voltage sensing circuit that filters noise from the current and voltage measurements;
a phase measurement circuit coupled to the noise filter circuit configured to receive the filtered current and voltage measurements as inputs and to output phase measurements of the current and voltage and a difference in phase between the current and voltage measurements; and
a resonant frequency tracking circuit coupled to the phase measurement circuit configured to receive as inputs the phase measurements of the current and voltage and the difference in phase, calculate a second resonant frequency, and output to the motor drive circuit a frequency command corresponding to the second resonant frequency.

### Claim 12 (depends on 11)

The apparatus of claim 11, further comprising a phase compensation filter with an input coupled to the noise filter circuit and an output coupled to the phase measurement circuit, configured to receive filtered current measurements, filter the filtered current measurements, and provide an output to the phase measurement circuit.

### Claim 13 (depends on 11)

The apparatus of claim 11, wherein the noise filter circuit is a bandpass filter.

### Claim 14 (depends on 11)

The apparatus of claim 11, wherein the noise filter circuit is a low pass filter.

### Claim 15 (depends on 11)

The apparatus of claim 11, wherein the current and voltage sensing circuit only measures current, and a voltage from the motor drive circuit is input directly to the noise filter circuit.

### Claim 16 (depends on 11)

The apparatus of claim 11, wherein the current and voltage sensing circuit only measures voltage, and a current from the motor drive circuit is input directly to the noise filter circuit.

### Claim 17

A system for closed loop control of a linear resonant actuator comprising:
a motor drive circuit configured to generate a motor drive signal having a frequency of a first resonant frequency;
a current and voltage sensing circuit configured to measure current and voltage from the motor drive signal;
a noise filter circuit configured to receive the current and voltage measurements and to filter noise from the current and voltage measurements;
a phase measurement circuit configured to receive the filtered current and voltage measurements and to output phase measurements of the current and voltage and a difference in phase between the current and voltage measurements; and
a resonant frequency tracking circuit configured to receive the phase measurements of the current and voltage and the difference in phase, calculate a second resonant frequency, and output to the motor drive circuit a frequency command corresponding to the second resonant frequency.

### Claim 18 (depends on 17)

The system of claim 17, further comprising a phase compensation filter configured to receive filtered current measurements from an output of the noise filter circuit, filter the filtered current measurements, and provide an output to the phase measurement circuit.

### Claim 19 (depends on 17)

The system of claim 17, wherein the noise filter circuit is a bandpass filter.

### Claim 20 (depends on 17)

The system of claim 17, wherein the noise filter circuit is a low pass filter.

### Claim 21 (depends on 17)

The system of claim 17, wherein the current and voltage sensing circuit only measures current, and a voltage from the motor drive circuit is input directly to the noise filter circuit.

### Claim 22 (depends on 17)

The system of claim 17, wherein the current and voltage sensing circuit only measures voltage, and a current from the motor drive circuit is input directly to the noise filter circuit.
