Numerous devices such as smart phones, smart watches, tablets, automobiles, aerial drones, appliances, aircraft, exercise aids, and game controllers may utilize sensors such as microelectromechanical system (MEMS) sensors during their operation. In many applications, various types of motion sensors such as accelerometers and gyroscopes may be analyzed independently or together in order to determine varied information for particular applications. For example, gyroscopes and accelerometers may be used in gaming applications (e.g., smart phones or game controllers) to capture complex movements by a user, drones and other aircraft may determine orientation based on gyroscope measurements (e.g., roll, pitch, and yaw), and vehicles may utilize measurements for determining direction (e.g., for dead reckoning) and safety (e.g., to recognizing skid or roll-over conditions).
MEMS gyroscopes typically require that a drive force be applied to movable components of the suspended MEMS structure to initiate a drive motion of those components, such as via an electrostatic drive system. This drive motion is directly or indirectly imparted on proof masses which are able to move in a direction perpendicular to the direction of the drive motion in response to a Coriolis force generated by a rotation of the MEMS gyroscope about an axis perpendicular to the direction of the drive motion. Accordingly, the Coriolis force that is used to determine angular velocity is based on the drive motion and the drive motion is monitored and controlled to ensure a consistent drive amplitude and waveform (e.g., drive frequency and phase). This drive monitoring and control circuitry is primarily implemented with analog components that occupy a substantial amount of circuit area of a MEMS gyroscope.
In an embodiment of the present disclosure, a microelectromechanical system (MEMS) gyroscope comprises a suspended spring-mass system comprising a driven mass and a drive system operably coupled to the driven mass via the suspended spring-mass system to impart a drive motion onto the driven mass based on a drive signal. The MEMS gyroscope may further comprise one or more drive sense electrodes located proximate to the driven mass to generate a drive sense signal based on the drive motion of the driven mass and processing circuitry. The processing circuitry may be configured to receive the drive sense signal, rectify the drive sense signal, subtract the rectified drive sense signal from a drive reference signal to generate an analog error signal, digitize the analog error signal to generate a digitized error signal, digitally filter the digitized error signal with a digital filter, generate a pulse-width-modulated drive control signal based on the digitally filtered digitized error signal, and generate the drive signal in proportion to the pulse-width-modulated drive control signal.
In an embodiment of the present disclosure, a MEMS gyroscope comprises a suspended spring-mass system comprising a driven mass and a drive system operably coupled to the driven mass via the suspended spring-mass system to impart a drive motion onto the driven mass based on a drive signal. The gyroscope may further comprise one or more drive sense electrodes located proximate to the driven mass to generate a drive sense signal based on the drive motion of the driven mass and processing circuitry. The processing circuitry may be configured to receive the drive sense signal, digitize the drive sense signal, digitally process the digitized drive sense signal with a high-pass filter, and utilize a zero-crossing detector and a programmable delay to generate a square wave drive signal with a programmable phase with respect to the drive sense signal.
In an embodiment of the present disclosure, a method for driving a MEMS gyroscope comprises generating, by one or more drive sense electrodes located proximate to a driven mass of a suspended spring-mass system, a drive sense signal based on a drive motion of the driven mass. The method may further comprise rectifying the drive sense signal, subtracting the rectified drive sense signal from a drive reference signal to generate an analog error signal, and digitizing the analog error signal to generate a digitized error signal. The method may further comprise digitally filtering the digitized error signal, generating a pulse-width-modulated drive control signal based on the digitally filtered digitized error signal, generating a drive signal in proportion to the pulse-width-modulated drive control signal, and imparting, by a drive system operably coupled to the driven mass via the suspended spring-mass system, a drive motion onto the driven mass based on the drive signal.
The above and other features of the present disclosure, its nature, and various advantages will be more apparent upon consideration of the following detailed description, taken in conjunction with the accompanying drawings in which:
MEMS gyroscopes typically operate based on sensing of a Coriolis force. A portion of the MEMS gyroscope may be fabricated to include a number of interconnected components within a MEMS layer, such as springs, masses, anchoring points, and lever arms, which may collectively be referred to as a suspended spring-mass system. Components of the suspended spring-mass system are caused to oscillate in a linear motion along an axis or in a rotational motion about an axis, or in some implementations, a combination thereof. The oscillation is caused by a drive force which is imparted on directly driven components (e.g., a drive mass) such as by electrostatic forces imparted by an actuator (e.g., a drive electrode) located adjacent to the directly driven component. The drive of the directly driven component typically causes the motion of a variety of other components of the suspended spring-mass system, such as a proof mass that is used to sense the Coriolis force. The proof mass may be connected within the suspended spring-mass system such that it is capable of moving in response to the Coriolis force, which in turn is generated based on an angular velocity about an axis perpendicular to the drive axis, based on the drive motion. Accordingly, sensing of the force of interest (e.g., angular velocity) is dependent upon the characteristics of the drive motion, such as drive amplitude, drive velocity, and drive frequency.
The movement of a driven mass (e.g., a directly driven drive mass and/or an indirectly driven proof mass) may be sensed such as by using electrostatic sensing with a drive sense electrode located adjacent to the driven mass along the drive direction. A capacitance between the driven mass and a fixed drive sense electrode changes based on the changing distance between the driven mass and the drive sense electrode due to the drive motion. The drive amplitude and/or frequency of the driven mass can be monitored in a drive loop in order to dynamically adjust the drive signal that imparts the drive force onto the suspended spring-mass system, such that a desired drive motion is provided. This gyroscope drive regulation loop typically requires several analog components operating at low frequency, including one or two high-pass filters and a low frequency proportional-integral loop filter. Moreover, because the actuator needs to drive a relatively high voltage on the drive electrodes, a high voltage linear amplifier is typically used to control the amplitude of the drive harmonic imposed at the electrodes. Both of these features (low frequency filters and high voltage linear amplifier) occupy a large area in analog processing of the drive sense signal. In some instances, MEMS gyroscopes have attempted to overcome these large area consumption issues by performing some of these operations with digital processing. However, a significant drawback of existing digital implementations is that they require a relatively sophisticated analog-to-digital converter, such that the entirety of the drive sense capacitance-to-voltage (DC2V) output waveform is digitized at high frequency.
In accordance with the present disclosure, an analog processing stage preprocesses the drive sense signal for monitoring and control by a digital processing stage. This analog processing performs a number of processing steps on a received drive sense signal to generate a digital error signal, including rectifying the drive signal, demodulating the drive signal to baseband from the drive frequency, and subtracting a reference signal from the rectified and demodulated signal. The reference signal corresponds to a desired amplitude of the drive sense signal such that the remaining signal corresponds to the drive sense amplitude error. This drive sense error is integrated over a drive cycle and only this integrated drive sense error is digitized and only once a drive cycle. This allows a simple analog-to-digital converter (ADC) such as a successive approximation register (SAR) ADC to be utilized for digitizing the drive amplitude error for further digital analysis and processing. This results in simplification of the ADC design and optimizes the power consumption of the system. Furthermore, the same SAR ADC can be shared with the Coriolis sense path, further optimizing area occupation.
The processing of the drive amplitude error is performed in the digital domain, resulting in significant area savings compared to a primarily analog control loop. Drive signal amplitude control is performed with a pulse width modulator (PWM), allowing the typical high voltage linear amplifier to be removed from this design. The duty cycle of the PWM is modified in accordance with the received drive amplitude error signal to drive that error towards zero. Prior to modifying the PWM output, the drive amplitude error signal is filtered digitally and a predistortion is applied to maintain linearity. The output of the PWM is provided to a digital decoder which in turn directly controls drive signal generation by a high voltage drive, eliminating the need for an additional digital-to-analog converter.
In addition to the digital drive control loop utilized during normal operation, the start-up sequence for the MEMS gyroscope drive may be performed digitally, for example, until an initial drive amplitude is achieved. While the MEMS gyroscope is initially at rest, forces such as stiction and the initial inertia of the suspended spring-mass system must be overcome to initialize the drive motion. An open-loop digital burst sequence may initially be applied to overcome these initial forces, for example, for a predetermined time period. The drive signal may then be monitored directly (e.g., without analog generation of an error signal) as a digital start-up sequence is performed. The digital start-up sequence monitors the drive sense signal characteristics such as amplitude and phase and applies a predetermined phase shift to the signal until a criteria for the drive sense signal such as a predetermined amplitude threshold is met, after which processing may be switched to the drive control loop analog and digital path for ongoing sensor operation.
Processing circuitry 104 may include one or more components providing processing based on the requirements of the MEMS system 100. In some embodiments, processing circuitry 104 may include hardware control logic that may be integrated within a chip of a sensor (e.g., on a base substrate of a MEMS gyroscope 102 or other sensors 108, or on an adjacent portion of a chip to the MEMS gyroscope 102 or other sensors 108) to control the operation of the MEMS gyroscope 102 or other sensors 108 and perform aspects of processing for the MEMS gyroscope 102 or the other sensors 108. In some embodiments, the MEMS gyroscope 102 and other sensors 108 may include one or more registers that allow aspects of the operation of hardware control logic to be modified (e.g., by modifying a value of a register). In some embodiments, processing circuitry 104 may also include a processor such as a microprocessor that executes software instructions, e.g., that are stored in memory 106. The microprocessor may control the operation of the MEMS gyroscope 102 by interacting with the hardware control logic and processing signals received from MEMS gyroscope 102. The microprocessor may interact with other sensors 108 in a similar manner. In some embodiments, some or all of the functions of the processing circuitry 104, and in some embodiments, of memory 106, may be implemented on an application specific integrated circuit (“ASIC”) and/or a field programmable gate array (“FPGA”).
Although in some embodiments (not depicted in
In some embodiments, certain types of information may be determined based on data from multiple MEMS gyroscopes 102 and other sensors 108 in a process that may be referred to as sensor fusion. By combining information from a variety of sensors it may be possible to accurately determine information that is useful in a variety of applications, such as image stabilization, navigation systems, automotive controls and safety, dead reckoning, remote control and gaming devices, activity sensors, 3-dimensional cameras, industrial automation, and numerous other applications.
In embodiments of the present disclosure, a gyroscope drive sensing and control system is implemented as a drive loop with mixed analog and digital processing. During an initial start-up phase of operation, a signal such as an initial digital burst signal is provided to control a high-voltage drive (e.g., via a digital high-voltage drive decoder) that in turn applies a force such as an electrostatic force to one or more components of the MEMS gyroscope (e.g., by applying an electrostatic force to one or more drive masses of a suspended spring-mass system via one or more drive electrodes) to initiate the drive motion on the MEMS gyroscope, for example, to overcome any initial stiction associated with the suspended spring-mass system of the MEMS gyroscope while at rest. Once the drive motion is initiated, the drive motion of one or more components (e.g., a driven mass such as the drive mass or a proof mass driven by the drive mass) is sensed and the MEMS gyroscope switches from the initial (e.g., burst) portion of the start-up phase to a start-up portion of the start-up phase in which the sensed signal is monitored (e.g., the amplitude and/or phase of the drive sense signal) until the drive sense output is suitable to allow the operational drive loop to begin.
During this operational drive loop both analog processing circuitry and digital processing circuitry are utilized to monitor and control the drive loop. The drive sense signal is initially processed by the analog processing circuitry, for example, by rectifying the drive sense signal, demodulating the drive sense signal, subtracting a reference signal from the rectified and demodulated drive sense signal, and integrating the result of the subtraction to generate an analog error signal. The analog error signal is digitized and is provided to a digital filter (e.g., a proportional-integral or PI filter) which attempts to minimize the digital representation of the integration output, which in turn corresponds to driving the rectified and demodulated drive sense output to match the reference signal. The digital filter may also include additional filtering operations such as applying a sinc function to the digital digitized analog error signal prior to the PI control function. The digital filter may also include a low-pass filter that is applied to the output of the PI control function. Digital control of the high voltage drive is provided such as via a pulse-width modulator that adjusts its duty cycle in accordance with the amplitude of the drive signal to be output by the high voltage drive. In order to linearize a transfer function of the pulse width modulator, a pre-distortion function may be applied to the output of the digital filter.
Relevant to the present drive loop discussion, MEMS components and circuitry 206 outputs a drive sense signal that is based on measuring a physical drive motion applied to one or more components of a MEMS device such as a drive mass or proof mass of a MEMS gyroscope, based on a drive signal provided to the MEMS components and circuitry 206 from drive circuitry 218. The exemplary embodiments depicted herein are directed to drive monitoring and control, and thus do not depict other sensing and control paths of the MEMS device such as a Coriolis sense path from MEMS components and circuitry 206, although various components such as C2V amplifiers, multiplexers, demultiplexers, and analog-to-digital converters (ADCs) may be shared between such other circuitry and the drive loop circuitry depicted and described herein.
The drive sense signal output from MEMS components and circuitry 206 is output to analog drive loop circuitry 208 and to internal timing circuitry. Internal timing circuitry 210 monitors the phase of the drive sense signal and, in conjunction with external timing circuitry 211, generates and distributes various timing signals for components of the gyroscope drive control loop, for example, to use in performing demodulation, phase alignment, phase shifting, and the like. Analog drive loop circuitry 208 provides for analog processing of the drive sense signal such as signal multiplexing (e.g., for selectively routing different differently modified drive sense signals to an analog-to-digital converter for routing to digital start-up drive control 212 or digital drive loop control 214), rectification, demodulation, reference signal comparison, integration, and analog-to-digital conversion. The output (e.g., a digital output signal) of analog drive loop circuitry is provided to both digital start-up drive control 212 and digital drive loop control 214, although only one of digital start-up drive control 212 or digital drive loop control 214 may process processing the output signal at a time in an exemplary implementation.
Digital start-up drive control 212 is utilized when the MEMS gyroscope is initially at rest and/or is operating at an amplitude and/or phase which does not meet certain criteria. For example, at an initial start-up of the MEMS gyroscope (e.g., of MEMS components and circuitry 206) an initial burst drive may be provided (e.g., for a predetermined time period) to overcome stiction and other initial forces and begin the oscillation of the drive masses and other driven components of a suspended spring-mass system of the MEMS gyroscope. Once the drive oscillation has been initiated, the digital start-up drive control may transition to a start-up operational stage in which an initial drive waveform (e.g., a 50% duty cycle waveform) is provided until certain criteria are met (e.g., until a certain drive sense amplitude is achieved at an appropriate phase). Once the start-up criteria is achieved, the gyroscope drive loop switches to operational drive loop operation, for example, by modifying a signal processing path within the analog drive loop circuitry 208 to prepare the drive sense signal for processing by digital drive loop control 214.
As an example, during the operational drive loop operation the drive sense signal may be rectified and demodulated (e.g., from the drive frequency to baseband) and modified by a reference signal. The reference signal may be a controllable current that is selected such that if the drive sense signal has the proper amplitude the result of the modification of the rectified and demodulated drive sense signal by the reference signal is essentially a zero output provided to the next analog processing stage, which is an integrator that averages the difference between the rectified and demodulated drive sense signal as compared to the reference signal over a predetermined period of time. The integrated difference is provided to an ADC converter to prepare the signal for processing by the digital drive loop control, which generates an output control signal that is provided to the digital drive controller 216 to control the amplitude and phase/frequency of the drive signal output from drive circuitry 218 to components such as drive electrodes of the MEMS components and circuitry 206 (e.g., a pulse width modulated (PWM) control signal for selectively modifying the drive signal in accordance with PWM duty cycle).
An analog portion of internal timing circuit 210 includes a comparator 213 coupled to the drive sense output from C2V amplifier 222. The oscillation phase of the drive motion is derived by comparator 213 that changes its state based on a comparison of the drive sense output from C2V amplifier to a threshold, which may be selected based on a desired signal level to trigger changes in the comparator 213 output. Although not depicted in
Analog drive loop circuitry 208 is depicted in
The rectified and demodulated drive sense signal is representative of the baseband amplitude of the drive motion. This signal is then compared to a value representative of a target drive motion for the system. Generally, this will be a fixed value based on the system design, although the target drive motion may be modified, for example, based on a desired power consumption or differing requirements for precision/accuracy at different times (e.g., noise or temperature compensation). In some embodiments, the value representative of the target drive motion may be implemented by reference signals 228, which may be reference current sources Iref0 and Iref1, which are selected such that when the output of demodulator 226 corresponds to the target drive motion, the inputs of the amplifier 234 of the integrator 229 (e.g., as implemented by amplifier 234, switches 230a and 230b, and capacitors 232a and 232b) will see approximately zero current resulting in a zero output voltage from amplifier 234, while differences between the target drive motion and the drive motion represented by the rectified and demodulated drive sense signal will be represented at the output of amplifier 234 as a positive or negative voltage.
Although integrator 229 may be implemented in a variety of manners, in the embodiment of
In some embodiments as depicted in
In the embodiment of
Internal timing circuitry 210 is depicted in
Digital start-up drive control 212 is depicted in
Digital start-up drive control 212 also includes the start-up drive path, which includes high-pass filter 250, amplitude detector 252, phase detector 254, and phase shift 256. In the embodiment depicted in
Digital drive loop control 214 is depicted in
As is depicted in
As is depicted by integrated reference signal 310, the reference signal is a constant current that would integrate as a linear ramp. The integrated DC2V signal 312 integrates as a ramp with an oscillation corresponding to the slope of the DC2V rectified signal 304. When the integrated reference signal 310 is subtracted from the integrated DC2V (e.g., by integrator 229), the resulting amplitude of the integrator output signal 314 corresponds to the drive sense error.
Continuing to
At step 402, an initial burst drive signal is provided to initiate movement of the drive system of the suspended spring-mass system of the MEMS gyroscope, as is depicted and described in more detail in
At step 404, the sense and drive path of the analog and digital processing circuitry may be modified to enable a start-up drive path to provide monitoring and control of the HVD drive and corresponding drive sense output. In the analog domain, circuitry such as a multiplexer may connect a drive sense signal (e.g., an output from a DC2V amplifier connected to drive sense electrodes) to the ADC such that the digital start-up processing is based directly off the drive sense signal. The digital startup drive path may also be connected (e.g., by a multiplexer) between the digital start-up processing and the HVD decoder, to facilitate the start-up drive to control the HVD. Processing may then continue to step 406.
At step 406, the start-up drive sequence with drive delay may be applied to the MEMS gyroscope, as is depicted and described in more
At step 408, after the start-up phase is complete, the drive error processing path may be connected to the ADC. Within the analog domain the drive sense signal is processed and modified to isolate an error between the drive sense output and a desired drive amplitude for the MEMS gyroscope. Circuitry such as a multiplexer may connect this drive error processing signal path to the ADC, such that a digitized version of the drive error signal may be utilized to control the drive signal. In addition, a digital drive loop control may be connected to control the HVD, such as by a multiplexer that connects the digital drive loop control to the HVD controller. Once the drive error path has been connected, processing may continue to step 410.
At step 410, the operational drive loop control is performed to maintain the drive signal at a desired amplitude, as is depicted and described in more detail in
In some implementations, certain components such as the ADC may be shared between the drive loop and the sense path that measures angular velocity. Sense electrodes located adjacent to a proof mass sense movements due to a Coriolis force (i.e., perpendicular to the drive motion) to generate a sense signal that is processed by a C2V amplifier and additional processing circuitry (e.g., filters, integrator, etc.). This Coriolis sense signal may be periodically connected to the ADC to generate a digital signal that undergoes additional digital processing to measure angular velocity, providing significant area savings over separate ADCs. Accordingly, at step 412, the Coriolis sense path may be connected to the ADC after which processing may continue to step 414 to determine angular velocity. After angular velocity has been determined, the operational drive and sense loop may continue, with the ADC periodically being switched between the drive error sense and Coriolis sense paths.
At step 504, a digital burst control generates an initial burst signal, for example, having a predetermined duty cycle and frequency (e.g., corresponding to the resonance frequency for the MEMS gyroscope). At this initial stage, the burst signal is output in an open loop, such as for a predetermined period of time, without feedback from the drive sense electrodes. Once the digital burst signal is generated, processing may continue to step 506.
At step 506, an HVD decoder receives the digital burst signal and converts the signal to a PWM drive signal that is provided to drive the HVD. In an embodiment, the HVD decoder generates differential pulse-width modulated signals that are provided as digital inputs to the HVD. Processing may then continue to step 508, at which the HVD generates the drive signal (e.g., a PWM drive signal) at an amplitude based on the duty cycle of the signals provided by the HVD decoder and at the frequency (e.g., resonance frequency) of these signals. The drive signal is provided to drive electrodes which in turn initiate the movement of the components of the spring mass system while the burst signal is being applied. Once the time period for applying the burst signal has ended, the processing of
At step 602, the digitized drive sense signal is high-pass filtered. Because the drive sense signal has not been demodulated prior to processing by the digital start-up control, the relevant signal will be at drive frequency. High-pass filtering retains the relevant drive sense signal while at least partially removing lower frequency offset and noise, such as from the multiplexer and/or ADC. Once the high-pass filtering is complete, processing may continue to step 604.
At step 604, the filtered digital drive sense signal may be monitored for signal amplitude, while at step 606, the filtered digital drive sense signal may be monitored for signal phase and frequency. These values are used to determine whether the MEMS gyroscope drive has achieved suitable characteristics to begin normal (e.g., with DC2V amplitude value near to expected target) operation, as determined at step 614. Once the amplitude and phase have been monitored, processing may continue to step 608.
At step 608, a phase shift is applied to the filtered digital drive sense signal to continue the driving of the drive system of the MEMS gyroscope. For example, a phase shift may account for signal propagation and other sub-block delays, such that the actual drive control remains synchronized with the drive sense with a 90 degree phase shift to optimize the drive efficiency. The resulting phase-shifted signal (e.g., having a predetermined duty cycle such as 50%) may then be provided to the HVD decoder (e.g., via a multiplexer), and processing may continue to step 610.
At step 610, an HVD decoder receives the phase-shifted startup drive signal and converts the signal to a PWM drive signal that is provided to drive the HVD. In an embodiment, the HVD decoder generates differential pulse-width modulated signals that are provided as digital inputs to the HVD. Processing may then continue to step 612, at which the HVD generates the drive signal (e.g., a PWM drive signal) at an amplitude based on the duty cycle of the signals provided by the HVD decoder and at the frequency (e.g., resonance frequency) of these signals. The drive signal is provided to drive electrodes which in turn cause the movement of the components of the spring mass system. Processing may then continue to step 614.
At step 614, it may be determined whether the start-up drive loop is complete. For example, one criteria may be whether the amplitude has exceeded a value associated with consistent processing of the drive sense signal by a comparator of timing circuitry for a predetermined period of time. Another criteria may be whether the phase and frequency of the received drive sense signal are consistent. If the criteria are not met, processing may return to step 602 for additional start-up drive processing. If the criteria are met, the digital start-up control may end.
At step 702, a sinc function is applied to the digitized drive error signal to remove any offset contribution from the drive error signal that may have been added by analog error signal processing components such as an integrator and/or ADC. Processing may then continue to steps 704 and 706, at which a proportional-integral filter and low-pass filter reduce noise that are added to the drive error signal by the by the integrator and/or ADC. The proportional-integral filter also attempts to minimize the digital representation of the integration output, which in turn corresponds to driving the rectified and demodulated drive sense output to match the reference signal. Processing may then continue to step 708.
At step 708, predistortion control is included to counteract non-linearities that are added by the pulse width modulator. Predistortion control linearizes the overall transfer function of the digital drive loop control to improve the stability of the drive loop. Once the predistortion is applied to the filtered digital drive error signal, processing may continue to step 710.
At step 710, a pulse width modulator generates a digital pulse width modulation control signal to modify the drive signal in a manner to reduce the drive error, for example, by decreasing a duty cycle of a PWM drive when the drive sense amplitude is greater than a reference signal and increasing a duty cycle of a PWM drive when the drive sense amplitude is less than a reference signal. Processing may then continue to step 712.
At step 712, an HVD decoder receives the PWM control signal and converts the signal to a PWM drive signal that is provided to drive the HVD. In an embodiment, the HVD decoder generates differential pulse-width modulated signals that are provided as digital inputs to the HVD. Processing may then continue to step 714, at which the HVD generates the drive signal (e.g., a PWM signal) at an amplitude based on the duty cycle of the signals provided by the HVD decoder and at the frequency (e.g., resonance frequency) of these signals. The drive signal is provided to drive electrodes which in turn cause the movement of the components of the spring mass system. Processing then returns to step 702 to continue the drive loop.
The foregoing description includes exemplary embodiments in accordance with the present disclosure. These examples are provided for purposes of illustration only, and not for purposes of limitation. It will be understood that the present disclosure may be implemented in forms different from those explicitly described and depicted herein and that various modifications, optimizations, and variations may be implemented by a person of ordinary skill in the present art, consistent with the following claims.
Number | Date | Country | |
---|---|---|---|
63531489 | Aug 2023 | US |