1. Introduction
A high-performance micro-machined MEMS gyroscope is appealing to many researchers as it is advantageous in terms of power, cost and flexibility over the bulky and expensive macroscopic gyroscopes. When an MEMS gyroscope is moving in a direction and an angular velocity is applied to the gyroscope, the sensing element will experience a displacement as a result of Coriolis force. The incorporation of the Delta-Sigma (Δ∑) modulator to the gyroscope sensing element is one of the most promising approaches to implement the MEMS gyroscope due to the circuit simplicity and the benefits of incorporating the sensing element in a feedback control loop [1] to improve the sensing stability. The Δ∑ modulation-embedded MEMS gyroscope was first introduced in [2], and ever since has become a popular research topic in the literature [3,4,5,6,7].
As an efficient A/D conversion method, the Δ∑ modulator can be embedded into many industrial applications, e.g., [8,9,10,11]. Along with the development of the Microelectromechanical Systems (MEMS), the Δ∑ modulator-based gyroscopes and accelerometers may be used in many applications. For instance, it is possible to choose MEMS gyroscopes as the sensing device for small satellite missions, e.g., [12]. However, due to the non-linear nature of the quantizer, the extra integrators in the gyroscope transfer function may cause stability issues in the control loop. Moreover, the compensator will also introduce extra poles in the control loop and consequently affect the noise-shaping performance of the system [5]. Additional integrators, serving as usual noise shaping solutions, are adopted in the feedback loop to attenuate the magnitude of the impulse response of the noise transfer function (NTF) at low frequencies (see e.g., [13] for different Δ∑ modulator-based MEMS gyroscope structures). This methodology is analogous to a PID (Proportional-Integral-Derivative) control system, in which the performance of the designed system depends on the experience of the designer [14].
Among various ∆∑ modulation methods, the ones with bi-level quantizers are more attractive because of their circuit simplicity and the binary nature of the quantizer outputs. They have been proven to be an efficient alternative to the multi-level quantizers [15]. Such bi-level quantizers are used to develop the multiplier free analog to digital (A/D) converters, e.g., [16], to achieve the simplest digital hardware circuitry. Based on the bi-level quantizer, the concept of 1-bit processing has been widely investigated in the context of finite-impulse-response (FIR) filters [17], infinite-impulse-response (IIR) filters e.g., [18], and digital communication e.g., [19,20]. One of the many successful applications of 1-bit processing is in audio applications (e.g., [21,22]), where the 1-bit coding scheme is used to develop high frequency (64 or 128 times 44.1 kHz) encoding technology for the audio industry. A multiplier free control system has been proposed by [23], namely, the 1-bit processing control system. As the signals are in the 1-bit format, multipliers can be removed by choosing a modified controller structure [24].A 1-bit processing-based MPC (OBMPC) method was then developed in [25] to extend the 1-bit processing-based control system to advanced control algorithm applications.
Inspired by the 1-bit processing-based A/D conversion and 1-bit processing-based control systems, an implementation of a novel OBMPC for the MEMS gyroscope is developed in this work. The authors provide the design of an MPC algorithm for the bi-level ∆∑ modulator-based MEMS gyroscope (1-bit MEMS gyroscope) and discusses the potential issues of implementing such an OBMPC-based MEMS gyroscope. A new OBMPC structure is designed to implement the 1-bit MEMS gyroscope with a high sampling rate. As one of major benefits of the MPC algorithm, the proposed OBMPC structure can include the constraints in the quantizer inputs, which serve as the stabilization technique for the Δ∑ modulator while providing a better SNR when quantizer overloading occurs.
The rest of this paper is organized as follows. Section 2 describes the Δ∑ Modulator-based MEMS gyroscope. Section 3 details the design of the OBMPC-based MEMS gyroscope. Experimental results are described in Section 4. Finally, conclusions are presented in Section 5.
2. Δ∑ Modulator-Based MEMS Gyroscope
A typical approach to design a Δ∑ modulator-based MEMS gyroscope is to treat the MEMS gyroscope as a Δ∑ modulation-based control loop. For most MEMS gyroscopes, the angular motion is determined by measuring the vibration of the proof mass, which is excited due to Coriolis force. The sense mode of the MEMS gyroscope can then be regarded as a spring damper dynamic system responding to Coriolis force, and hence can be modeled by two integrators in series. Figure 1 shows a system level diagram of a mechanical sensor.
Where K is the spring stiffness, andω02π is the resonant frequency of the dynamic system. For the sensing mode of the gyroscope, the control loop design problem can also be treated as the Δ∑ modulator-based accelerometer under Coriolis force, e.g., [26,27]. The continuous-time transfer function of the mechanical sensor can be denoted as:
Hm(s)=1ms2+ω0Qs+ω0 2
where m is the mass of the sensing element,ω0is the resonant frequency andQ is the quality factor. High-quality factors are generally required to achieve high sensitivity of the sensor (200–250 for the sense mode and 35,000–45,000 for the drive mode [28]). Due to the phase shift introduced by the mechanical sensing element, a simple lead compensator must be included to stabilize the control loop. Other sensor fusion technologies are also available, e.g., [29,30,31], but are outside of the scope of this work. The output of the compensator can be regarded as the input of the Δ∑ modulator, which serves as an interface to digitalize the sensor signal. The resulting digital bit stream can be translated into an electrostatic force as the feedback to the control loop of the sensor [32].
To further analyze the stability and performance of the Δ∑ modulator-based MEMS gyroscope, one can treat the sensing component and the compensator as two second order loop filters, and then analyze the entire control loop as a high order Δ∑ modulator. The structure of the Δ∑ modulator-based MEMS gyroscope is shown in Figure 2.
Like any other A/D conversion method, the Δ∑ Modulation process introduces quantization noise into the MEMS control loop. Such quantization noise, coupled with mechanical noise and electrical noise, may cause large gyroscope bias and instability of the control loop. Filtering techniques are therefore required to decrease the in band noise. Filters can be embedded into the control loop before the A/D conversion as the Δ∑ modulator operates at over sampling rate (OSR) and can be constrained into a narrow frequency band. Also, the bandwidth requirements of the electronic components needed for implementation in the integrated circuit are relatively demanding as a high OSR is eventually required to achieve a good SNR.
One way to minimize the quantization noise is to increase the order of the Δ∑ modulator in the control loop at a cost of circuit complexity. A well designed high-order Δ∑ modulator-based MEMS gyroscope can filter most of the noise from the Δ∑ modulator loop. For instance, the results obtained in [33] proved that a SNR of 93 dB can be achieved with a relatively low OSR of 500, including realistic values for electronic noise introduced. Also, the integrators can be replaced with resonators, e.g., [26,28], to build a band-pass Δ∑ modulator. In this work, a bi-level Δ∑ modulator is used in the 1-bit MEMS gyroscope. A third order 1-bit MEMS gyroscope with an embedded resonator is shown in Figure 3.
More Δ∑ modulator-based MEMS gyroscope implementations can be found in a review paper [1].
3. OBMPC Structure for the 1-bit MEMS Gyroscope
In order to design a Δ∑ modulator-based MEMS gyroscope with guaranteed stability while maintaining a reasonable SNR, in this section, we adopt an MPC approach to implement the MEMS gyroscope. This approach uses the 1-bit feedback from the Δ∑ modulator and therefore can be defined as the 1-bit processing-based Model Predictive Control (OBMPC) in this paper.
3.1. Δ∑ Modulator with Parallel State Variables
The control objective is to find the integrator output which has minimized quantization error. The digital signal (e.g., a sampled continuous-time signal)a(k) shall be considered as the output of the MEMS gyroscope system and the input to a high order Δ∑ modulator. An nth order Δ∑ modulator structure is shown in Figure 4.
The state-space equations of the proposed structure can be written as
{xM(k+1)=AM xM(k)+BMa(k)−CM lm(k)yM(k)=DM[xM 1xM 2⋮xM n]
wherexM(k) ∈Rnis the state vector,AM=[100…0110…0011…0⋮⋱⋱⋱⋮0…010],BM=[b1b2b3⋮bn],CM=[c1c2c3⋮cn],DM=[d1,d2,…dn],xM∈R,yM(k)∈R, k∈N.lM(k), where lM(k)≜qΔ(yM(k)),is the quantizer output anda(k)∈R is the modulator input. To ensure that the input does not overload the controller, the state variables are required to be clipped. Specifically speaking, as presented in [34], for a second-order Δ∑ Modulator, with unit feedback gain, the state bound can be presented as
{|x1|max=|uin|+2|x2|max=(5−|uin |)28(1−|uin |)
whereuinis the modulator input,x1andx2 are, respectively, the states for the first and second integrators. The clipping principle is further generalized in [35] with different feedback gains. Ref. [36] provided state bounds analysis for the third-order Δ∑ Modulators. Although the principles discussed above are designed for sinusoidal inputs, they are fairly strict from the design point of view and can be considered as sufficient conditions for most designs [37]. To further simplify the problem, as suggested in [37,38], the clipping threshold can only be set to the last integrator. The variable gain method [39] can be used as the design guide of the hard constraints of the last integrator in the control loop. In practical cases, one can find out a “safe” threshold by studying the impulse response of a stable modulator.
The asymptotical stability of such Δ∑ modulators can be designed by moving all the eigenvalues ofAMinside the unit circle. The modulator is oversampled so thata(k)can be considered as constant within n time steps wheren≪OSR, i.e.,a(k)=a(k+1)…=a(k+n). x1(k), x2(k)…xn(k) are the state variables for the nth integrator.lMis weighted by a bi-level quantizer, wherelM∈{Δ,−Δ}. The quantization levelΔis standardized as 1 andl→M(k)is scaled byc1,c2,…cnaccording to the quantization level. In this particular case, the state matrixA→Mcan be transformed into the Jordan canonical form by replacingx→MwithPT −1 xM as used in [39],wherePT=(⋮⋮⋮⋮ρ1ρ2⋯ρn⋮⋮⋮⋮)andρ1,ρ2…ρnare the eigenvalues ofAM. Equation (3) then becomes:
{xM(k+1)=AM xM(k)+BMa(k)−CM lM(k)yM(k)=DM xM(k)
whereAM=PT AM PT−1,BM=PT BM,CM=PT CM.xM∈R,yM(k)∈R.
The main benefit for this structure is that the state variables are now decoupled. To further simplify the problem, defineDM≜[1,1,⋯,1] . The structure of the Δ∑ modulator with parallel state variables can then be reconstructed as shown in Figure 5.
In Figure 5,ρ1,ρ2…ρnare the eigenvalues ofAM. It is worth noting that the inclusion of linear feedback paths other than the resonators results in a diagonal canonical form ofAM. It is possible to extend such parallel structures to many Δ∑ modulator structures if the state matrixAM is similar to a diagonal matrix. In the following subsection, we shall assume that a simple diagonal state matrix is used. Then, each state variable can be easily clipped, or constrained, by the designer. Designing and implementing a clipper is one of the easiest ways to stabilize a Δ∑ modulator. The main challenge, however, lies in how to choose a reasonable clipping level while retaining the high SNR when the input does not overload the quantizer. In practical missions, if the non-ideal integrators and noises are taken into consideration, rigorous clipper level (typically much higher than the input signal for higher order Δ∑ Modulators, e.g., 90 times of the input signal for a third order Δ∑ Modulator), may result in low SNR at the noisy instants, even when the stability of the control loop can be guaranteed. Moreover, as a non-linear approach, the clipping technique will bring additional non-linearity to the Δ∑ Modulator, which is also a non-linear system itself, so that the stability analysis is even harder to perform (e.g., [40]). Hence, an OBMPC controller is proposed to be applied to such Δ∑ modulators. The proposed controller has the ability to handle hard constraints (i.e., the clipping thresholds) on all the state variables. Also, the order reduction is discussed in [39] for some particular Δ∑ modulators, which may help to decrease the online computation effort (if required) of the proposed method.
In some other cases, however, the use of resonators will result in a non-diagonalAM . These cases are studied in [39] and can be analyzed on a system-by-system basis. Generally, not all the state variables can be decoupled for the Δ∑ modulator structure with resonators. On the other hand, they can be written as a parallel state structure with a certain level of decoupling. Hence, it is still possible to decouple some of the state variables in most non-diagonal structures. For example, consider a third-order Δ∑ modulator with a resonator on the second and the third integrator. In this case, only the first integrator can be decoupled, which means it can be restructured to be in parallel with the other two integrators. In such a structure, the first and the third state variables are explicitly known. However, this will only require the study of the impulse response of a first-order NTF and a second-order NTF, respectively, which is easier than studying the third-order NTF directly to determine a reasonable a clipper level. The worst case is that none of the state variables can be decoupled. Hence, only the last state variable can be directly constrained. It is still possible to stabilize the modulator as suggested in [38]. However, the clipping action will result in a relatively low SNR in comparison to the individually clipped Δ∑ modulator. In the following section, we assume that the state matrix of the Δ∑ modulator in the proposed mission is designed to be diagonal. This was chosen to simplify the analysis such that case-by-case studies need not be performed for the proposed method.
3.2. OBMPC-based MEMS Gyroscope Using 1-bit Processing
3.2.1. Linearization Assumption and Problem Formulation
As discussed above, if the state variables can be decoupled, such that the constraints applied on the state variable are linearly independent, the OBMPC can be implemented with a relatively simple circuit under the framework of 1-bit processing control system. This means that the Karush-Kuhn-Tucker (KKT) [41] condition is sufficient to address such a problem. By linearizing the quantization noise [30], Figure 5 can be presented as seen in Figure 6.
In Figure 6,eM(k) is the filtered quantization noise. According to Figure 6,
lM(k)=yM(k)+eM(k).
DefineN(z)andS(z)as discrete linear time invariant filter representing the respective NTF and the Signal transfer Function (STF). S(z) can be presented in state space form as
{xM(k+1)=AP xM(k)+BS aM(k)yM(k)=CS xM(k)
whereAP=AM−CM DM,BS=BM,CS=DM. Similarly, by lettingaM(k)=0, N(z) in state space form is given as:
{xM(k+1)=AP xM(k)+BN eM(k)lM(k)=CN xM(k)+eM(k)
whereBN=CM,CN=DM. Additionally, defineE(k)as the unfiltered quantization noise, where
E(k)=(lM(k)−S(z)aM(k))
Therefore,
eM(k)=N(z)−1(lM(k)−S(z)aM(k))
The state space function forN(z)−1can be presented as:
{xf(k+1)=AF xf(k)+BFE(k)eM(k)=CF xf(k)+E(k)
whereAF=AM,BF=CM,CF=−DM,andxf∈Ris the state variable ofN(z)−1.
3.2.2. Unconstrained OBMPC Implementation
The goal here is to implement a control structure that minimizes the filtered quantization noiseeM(k) . A conceptual view of an OBMPC-based Δ∑ modulator is shown in Figure 7:
In Figure 7,uM=[uM 1,uM 2…uM n]Tis the control input that attempts to minimize the filtered quantization noise in Equation (11). An OBMPC is used in the modulation loop. The benefits of doing this are two-fold: Firstly, hard constraints can be easily included for each decoupled state variable, which provides more flexibility for the designer and the stability criteria can be easily acquired. Secondly, future predictions can be included in the control structure. Theoretically speaking, if the prediction horizon is long enough, then the quantization noise should tend towards zero.
Based on Figure 2 and Figure 7, a structure of the OBMPC based MEMS gyroscope can be designed as shown in Figure 8.
In Figure 8,a˜(k)is the signal applied to the MEMS gyroscope,a(k)is the sensing signal picked up by the MEMS gyroscope which is the narrow band of interest around the gyroscope resonant frequency andlM(k)is the quantizer output under the OSR. The optimal solutionuM *(k)has an affine relationship between the quantized output and multi-bit coefficients and therefore forms a 1-bit processing structure. Specifically, defineHM(z)andHC(z) as the transfer function of the discretized gyroscope dynamic model and the compensator, respectively. For the OBMPC controller presented above, define the prediction horizonNand vectors:
e⇀M(k)≜[e(k|k)e(k+1|k)…e(k+N|k)]T;u⇀M(k)≜[uM(k|k)uM(k+1|k)…uM(k+N−1|k)]T;E⇀(k)≜[E(k|k) E(k+1|k)…E(k+N−1|k)]T.
According to Equations (9) and (10):
{e⇀M(k)=FM xM(k)+ϑME⇀(k)E⇀(k)=l⇀M(k)−S(z)a⇀(k)
whereFM=[CFCF AFCF AF 2⋮CF AF N];??M=[DF00⋯0CF BFDF0⋯0CF AF BFCF BFDF⋯0⋮⋮⋮⋱⋮CF AF N−1 BFCF AF N−2 BFCAF N−3 BF⋯DF].
l⇀M∈RNanda⇀(k)∈RNare the predicted modulator input and output, respectively, along the prediction horizon. The cost function of Equation (11) can be built to minimize the filtered quantization noise:
J(xM,u⇀M(k))=minu⇀M(k){||xf(k+N|k)||PM2+∑i=0N−1(||xf(k+i|k)||QM2+||uM(k+i)||RM2)}
wherePM,QMandRMare positively defined weighting matrices. Define the main loop filterL(z)≜(zI−AM)−1and a control inputuM=[uM 1,uM 2…uM n]T as shown in Figure 8. Under the context of the MPC algorithm, if no constraint is applied, the MPC gain can be obtained by solving Equation (12) as:
KM=−Φ−1Ω
whereΩ≜Σi=1Np(∑j=0i−1 AF i−j−1 BF)QM AF i ∈RNp×n, andΦ≜Σi=1Np(∑j=0i−1 AF i−j−1 BF)QM (∑j=0i−1 AF i−j−1 BF)T+RM∈RNp×Np, whereQM≜diag(QM,QM….PM)∈RNpn×Npn, and RM=diag(RM,RM….RM)∈RNp×Np.
The global optimal solution of Equation (12) can be found as:
E⇀*(k)=−KM xf(k)
Based on Equation (11), the state variable ofN(z)−1can be derived as:
xf(k)=(zI−AF)−1 BF(S(z)a(k)−lM(k))
By substituting Equation (15) into Equation (14), Equation (16) is obtained:
E⇀*(k)=−KM (zI−AF)−1 BF(S(z)a(k)−lM(k)))
By substituting Equation (11) into Equation (16) and applying the receding horizon principle, the optimal modulator outputl*(k)can be found as:
lM *(k)=q([1,0….,0](S(z)a(k)+KM (zI−AF)−1 BF(S(z)a(k)−lM(k))))
Let the quantizer input be:
yM(k)=[1,0….,0](S(z)a(k)+KM (zI−AF)−1 BF(S(z)a(k)−lM(k)))
According to Equation (18), given the main loop filterL(z), the control inputuM(k)can be determined as:
uM *(k)=[1,0….,0]L(z)−1([1,z…zn−1]S(z)a(k)+KM (zI−AF)−1 BF(S(z)a(k)−lM(k))
By reformatting Equation (19), we obtain:
uM *(k)=[1,0….,0]L(z)−1(([1,z…zn−1]+KM (zI−AF)−1 BF)S(z)a(k)−KM (zI−AF)−1 BF lM(k))
By assigningL0=L(z)−1(([1,z…zn−1]+KM (zI−AF)−1 BF)S(z)), andL1=L(z)−1 KM (zI−AF)−1 BF, Equation (20) can be re-written as:
uM *(k)=[1,0….,0](L⇀0a(k)−L⇀1 lM(k))
Furthermore defineHA(z)≜K1 HM(z) HC(z) , then according to Figure 8
a(k)≜HA(z)(a˜(k)−K2 lM(k))
By substituting Equation (22) into Equation (21), the optimal control input can be obtained as:
uM *(k)=[1,0….,0](L0 HA(z)a˜(k)−(L1+L0 HA(z)K2)lM(k))
whereL_0=L(z)−1(([1,z…zn−1]+KM (zI−AF)−1 BF)S(z), andL1=L(z)−1 KM (zI−AF)−1 BF.
Note that the gyroscope outputa˜relatively slow comparing to the oversampled modulator output. Hence,a˜can be regarded as a constant signal withinltime steps (l= OSR), i.e.,a˜(k)=a˜(k+1)…=a˜(k+l)and the first component in Equation (23), i.e.,L0 HA(z)a˜(k), can be calculated under a relatively low sampling rate. If the quantization levels are standardized into±1, i.e.,lM(k)=±1, it can be seen from Equation (23) that the optimization is based on the gyroscope outputa˜(k)and the bi-level modulator output. Hence, for the second component in Equation (23), i.e.,(L1+L0 HA(z)K2)lM(k), the multiplications in the proposed structure are between a 1-bit signal and a multi-bit controller coefficient. This operation, in fact, just changes the sign of the multi-bit coefficient, which removes the multiplier from the controller, forming a multiplier free structure.
3.2.3. Hard Constraints on OBMPC based MEMS Gyroscope
The design of the Δ∑ modulator with parallel state variables provides more flexibility in terms of designing the constraints of each state variable. The constraint levels can be determined by studying the impulse response of each integrator or simply according to Equation (3). In the proposed parallel state structure, even if the state variable cannot be fully decoupled, the structure in each branch will still be relatively simple (typically second order if the coupling is merely caused by the resonator). Hence, it is relatively easy to determine a reasonable constraint level to each state variable.
Given a set of constraints applied to the state variables:
GM xM(k)≤γM
whereGMandγM are acquired based on the state bound for each integrator which can guarantee the stability of the modulator. The Hildreth’s QP procedure [42] is used in this work as an iteration method for the MPC algorithm. The same method has been adopted in [43] as an iteration method for the MPC algorithm.
When a set of active constraints is applied to the quantizer input a(k), the optimal solution can be solved iteratively by introducing the modified Lagrange factorλ¯:
uM *(k)=L0a˜(k)−L1 lM(k)−λ¯
whereλ¯∈Rp andλ¯i=S¯i+W¯(i,:) (zI−AF)−1 BF(S(z)a(k)−lM(k))).S¯ and W¯are the corresponding matrices are solved during the dual level iteration process. Hildreth’s QP algorithm is based on an element-by-element search and it does not require any matrix inversion. Therefore, the program will continue without interruption even when the rows of G are not linearly independent (e.g., more than one constraints are active). Also,λ¯is a near-optimal solution in a finite iteration loop. The iteration expression of Hildreth’s QP procedure is given in the following equation:
λ¯im+1=max(0,ωim+1)
whereωim+1=−1hii[ki+∑j=1i−1 hij λ¯jm+1+∑j=i+1n hij λ¯jm], and m means the mth iteration, the scalarhiiis the iith element in the matrixH=GM Φ−1 GM Tandkiis the ith element in the vectorK=γM+GMGΦ−1Ωx˜(k).λ¯(k)is calculated according to the previous one,λ¯(k−1), which can either be 0 or an affine function of the quantized measurementx˜(k−1). Given a finite number of iteration,λ¯can be solved as a near optimal solution even if two or more constraints are active at the same time. Therefore, even ifλ¯(k)cannot be solved explicitly, a set of near optimal control inputU(k)can still be found as an affine function over the state feedbackx˜(k).
If one or several of the constraints are violated, thenλ¯iwill be calculated accordingly. Note that since bothλ¯iand the global optimal solution presented in Equation (24) have an affine relationship with the 1-bit feedbacklM(k)(once againa(k)will be considered as constant within several time steps), the arithmetic block of the proposed OBMPC controller can process all the fast sampled operations with simple conditional-negates (CN) and bit shifters, and therefore achieves the 1-bit processing structure. In the proposed parallel structure, since the state variables are linearly independent, a simple active set method can be used to efficiently find the optimal KM and then in turn, find Ha and Hl.
4. Direct Implementation Method Using the OBMPC Approach
In the proposed structure, the hard constraints can be directly included into each of decoupled state variables according to the impulse response of each integrator. This can greatly simplify the design process. It is worth noting that Equation (13) is not strictly compliant with the 1-bit processing structure sincea˜(k)is the multi-bit counterpart of the analog signal. Modulatinga˜(k)into a 1-bit signal is not appropriate as this may increase the circuit complexity and introduce additional quantization noise into the control loop. However, as the system is oversampled,a˜(k)is relatively slow in comparison to the sampling rate. Hence, the computation burden is mainly caused by the second component in Equation (13), i.e.,(L1+L0 HA(z)K2)lM(k). If the bi-level quantizer is adopted, then the explicit relationship between the multi-bit parameters and the bi-level quantized signal can provide a multiplier free structure. Hence, the circuit simplicity of the 1-bit Δ∑ modulator will be preserved.
Essentially, the proposed OBMPC changes the zeros of the NTF by finding the optimal solution that minimizes the filtered quantization noise and therefore improves the performance of the system. For applications where the Δ∑ modulator is to be constructed using analog components (i.e., controllers are not feasible in the modulation loop), the MPC approach can still be treated as a design guideline to design a higher order Δ∑ modulator. TheKMthat is solved by the MPC can change the zeros of the NTF and therefore affect the noise shaping characteristics of the modulator. According to Equation (23), defineHa(z)=[L0 1b1,L0 2b2…L0 nbn]TandHl(z)=[−L1 1c1,−L1 2c2…−L1 ncn]T , then Figure 8 can be simplified as Figure 9.
TheKM in Figure 9 can be regarded as the functional scaling factor on each integrator to achieve a certainL⇀0andL⇀1. By designing the appropriate values forPMandQM(i.e., to satisfyAM T PM AM+QM=PM), the modulator can be safely scaled while the stability of the control loop is guaranteed. However, a major disadvantage of this approach is that the constraints cannot be directly included which means clipping or a different stabilization technique needs to once again be used in the modulator.
5. Numerical Example
In the interest of justifying the OBMPC controller in the MEMS gyroscope design, the simulation in this section focuses on the sense mode of the gyroscope. The input signal is acted upon by the proof mass of a second order spring and damping mechanical system as stated in Equation (1). The proof mass of the sense mode ism=1.96×10−9kg. The quality factor is set asQf=100and the resonance frequency of the mechanical system is 4000Hz. The quantization level is standardized into±1 V, and translated into the electrostatic feedback force by the gain of the voltage to force conversionK2=3.35×10−9 V/N. The input signal is first defined as a periodic input signal operating at64 rad/swith an amplitude of 0.6rad/s.
The structure of the MEMS gyroscope is shown in Figure 10a. The sampling time is set to1.625×10−9s (OSR = 200). A lead compensator is used to deal with the phase shift introduced by the mechanical sensing element. A simple second order Δ∑ modulator is presented here asAM=[1000.2],BM=[0.20.2],CM=[0.20.2], DM=[11]. The state space realization is shown in Equation (27):
{xM(k+1)=[1000.2]xM(k)+[0.20.2]aM(k)−[0.20.2]lM(k)yM(k)=[11][xM 1xM 2]
The filterN(z)−1can then be denoted as:
{xf(k+1)=[1000.2]xf(k)−[0.20.2]E(k)e(k)=[−1−1]xf(k)+ E(k)
If no constraint is applied and N = 4, thenKMcan be found as
KM=[−0.1584−0.0240−0.1411−0.0040−0.1245−0.0002−0.1064−0.0005]
Consequently,L⇀0andL⇀1can be found as:
L⇀0=z2−1.2365z+0.2111z2−0.8z−0.04
L⇀1=0.0365z−0.01110.4z−0.24
Based on the above equations, the control structure is shown in Figure 10b in comparison of a second order Δ∑ modulator structure.
We first assume the system is ideal (e.g., no electrical noises and internal distortion exist). Then the angular system input is a sinusoidal input. The delay caused by the filter is compensated in the generated result. A second order Δ∑ modulator based gyroscope is designed for benchmarking purposes.
The tracking trajectory and the spectra of both systems are plotted in Figure 11. As shown in Figure 11a,c, both systems show good tracking results to the input signal. The amplitude of the quantizer input shows some difference but none of them reached the constraint (as shown in Figure 11b). It can be seen from Figure 11c that the spectra are not much different (as expected) since no constraints are applied to the system. However, the OBMPC tends to be better than its benchmark when higher frequency is applied. This is due to the fact that the low pass filter in the designed system is less sufficient in the benchmark than the one in the OBMPC structure. This point will be further verified in the following simulations.
The amplitude of the input signal shall now be increased to 1.1rad/s , so that the quantizer will be overloaded. Constraints and clippers are set to both systems respectively according to Equation (2). The tracking trajectory and the spectra of both systems are plotted in Figure 12. In this scenario, the OBMPC-based MEMS gyroscope shows a notable improvement in comparison to its benchmark. The trajectory of the amplitude is closer to the input signal around the overloading area (as shown in Figure 12a,c) and the quantizer input is nicely shaped (as shown in Figure 12b) as the hard constraints are handled better by the OBMPC than the clipper. The spectra also show that the OBMPC based MEMS gyroscope performs better at both the peak (as shown in Figure 12c) and at higher input frequency (as shown in Figure 12b). The OBMPC basedΔ∑ modulator shows less noise leakage at the higher frequency as the OBMPC controller improves the original low pass filter in the loop.
To further discuss the character of the proposed MEMS gyroscope, the OBMPC-based MEMS is compared with its benchmark under different sampling frequencies. The SNR and the MSE of the quantization noise are plotted in Figure 13.
It can be seen that under high sampling frequencies (>104 Hz), the OBMPC-based MEMS gyroscope provide better SNR and lower noise level than its benchmark due to the use of MPC controller. Moreover, since the amplitude of the modulator input signal is important to the performance of the Δ∑ modulator based system, the SNR and MSE of the quantization noise under different input signal amplitudes are obtained as shown in Figure 14.
Figure 14 once again shows that the OBMPC based MEMS gyroscope provides better SNR and lower noise level than its benchmark due to the use of MPC controller. As the input amplitude approaches the quantization level, the quantization noise become even higher due to the integrators in the loop and may trigger the clippers or constraints in the respective design circuits. In this case, the clipper only chops the amplitude of the quantizer input rather than calculating the optimal value towards the cost function of the noise transfer function. Hence, the OBMPC-based MEMS gyroscope provides better SNR over the conventional Δ∑ modulator-based MEMS gyroscope. It is worth noting that if the amplitude of the input signal is much higher than the quantization level, then the system will no longer track the input signal and both systems will need to be redesigned (e.g., change the quantization level or the loop gain).
Finally, a random input with a random noise of relatively high amplitude and low frequency added to each of the integrators shall be simulated. The response of the Δ∑ modulator-based MEMS gyroscope for this scenario is given in Figure 15. It can be seen that the OBMPC-based MEMS gyroscope tracks the input signal better than its benchmark, especially around the quantization level, which proves the benefits of using the OBMPC controller in the MEMS gyroscope.
6. Conclusions
In this paper, an OBMPC algorithm for the 1-bit MEMS gyroscope was introduced. The challenges of the Δ∑ modulator-based MEMS gyroscope are mainly the randomness of the sensor input and the noise introduced by the mechanical and electrical systems. Hence, it is essential to improve the SNR while maintaining the robustness of the control system of the gyroscope control loop. In this work, we propose to include an OBMPC algorithm in the Δ∑ modulator-based gyroscope. Such a structure improves the SNR by minimizing the filtered quantization noise. As a result, constraints applied on the modulator state variables can be included in the controller directly, and an optimized gain can be determined so that the coefficients can be safely scaled. Due to the 1-bit nature of the modulated signal, if the state variable can be decoupled, so that the constraints applied to the state variable are linearly independent, the OBMPC can be implemented with relatively simple circuit under the framework of the 1-bit processing control system. Note that it is not necessary to apply constraints to all the state variables to stabilize the sensing output. Hence, if some of the modulator states cannot be decoupled, the constraint can be applied to the last state variable in that branch.
Simulation results show that the OBMPC-based MEMS gyroscope with a 2nd-order transfer function can provide better SNR than its conventional counterpart, especially when the signal amplitude is near the constrained levels. Also, the constraints of the MEMS gyroscopes can be designed to achieve guaranteed stability. For a higher order MEMS gyroscope model, the whole feedback loop with the OBMPC controller, the dynamic model and the delta sigma modulator can be regarded as a higher order delta sigma modulator. In this case, this will increase the system’s noise shaping capability and subsequently improve the signal-to-noise ratio.
Author Contributions
Conceptualization, X.W.; Methodology, X.W. and X.B.; Software, X.B.; Data curation, X.W. and X.B.; Validation, X.B. and Z.X.; Writing-original draft, X.W. and X.B.; Writing-review and editing, Z.X. and T.K.; Supervision, X.W.
Funding
This research was funded by the Australian Government Research Training Program scholarship.
Acknowledgments
The authors would like to express their gratitude with the reviewers and editors for their valuable comments to improve the quality of this manuscript.
Conflicts of Interest
Authors declare no conflicts of interest.
1. Kraft, M.; Ding, H. Sigma-delta modulator based control systems for MEMS gyroscopes. In Proceedings of the 4th IEEE International Conference on Nano/Micro Engineered and Molecular Systems (NEMS 2009), Shenzhen, China, 5–8 January 2009; pp. 41–46.
2. Jiang, X.; Seeger, J.I.; Kraft, M.; Boser, B.E. A monolithic surface micromachined Z-axis gyroscope with digital output. In Proceedings of the 2000 Symposium on VLSI Circuits, Digest of Technical Papers, Honolulu, HI, USA, 15–17 June 2000; pp. 16–19.
3. Petkov, V.P.; Boser, B.E. High-order electromechanical ΣΔ modulation in micromachined inertial sensors. IEEE Trans. Circuits Syst. I Regul. Pap. 2006, 53, 1016–1022.
4. Dong, Y.; Kraft, M.; Redman-White, W. Higher order noise-shaping filters for high-performance micromachined accelerometers. IEEE Trans. Instrum. Meas. 2007, 56, 1666–1674.
5. Raman, J.; Cretu, E.; Rombouts, P.; Weyten, L. A closed-loop digitally controlled MEMS gyroscope with unconstrained sigma-delta force-feedback. IEEE Sens. J. 2009, 9, 297–305.
6. Antonello, R.; Oboe, R. Exploring the potential of MEMS gyroscopes: Successfully using sensors in typical industrial motion control applications. IEEE Ind. Electron. Mag. 2012, 6, 14–24.
7. Dong, Y.; Zwahlen, P.; Nguyen, A.-M.; Rudolf, F.; Stauffer, J.-M. High performance inertial navigation grade sigma-delta MEMS accelerometer. In Proceedings of the 2010 IEEE/ION Position Location and Navigation Symposium (PLANS), Indian Wells, CA, USA, 4–6 May 2010; pp. 32–36.
8. Paramesh, J.; Von Jouanne, A. Use of sigma-delta modulation to control EMI from switch-mode power supplies. IEEE Trans. Ind. Electron. 2001, 48, 111–117.
9. Jacob, B.; Baiju, M. Space-Vector-Quantized Dithered Sigma–Delta Modulator for Reducing the Harmonic Noise in Multilevel Converters. IEEE Trans. Ind. Electron. 2015, 62, 2064–2072.
10. Acero, J.; Navarro, D.; Barragán, L.; Garde, I.; Artigas, J.; Burdío, J.M. FPGA-based power measuring for induction heating appliances using sigma–delta A/D conversion. IEEE Trans. Ind. Electron. 2007, 54, 1843–1852.
11. Jimenez, O.; Lucia, O.; Urriza, I.; Barragan, L.A.; Navarro, D. Design and Evaluation of a Low-Cost High-Performance–ADC for Embedded Control Systems in Induction Heating Appliances. IEEE Trans. Ind. Electron. 2014, 61, 2601–2611.
12. De Rooij, N.; Gautsch, S.; Briand, D.; Marxer, C.; Mileti, G.; Noell, W.; Shea, H.; Staufer, U.; Van Der Schoot, B. Mems for space. In Proceedings of the International Solid-State Sensors, Actuators and Microsystems Conference, 2009. (TRANSDUCERS 2009), Denver, CO, USA, 21–25 June 2009; pp. 17–24.
13. Miller, M.R.; Petrie, C.S. A multibit sigma-delta ADC for multimode receivers. IEEE J. Solid-State Circuits 2003, 38, 475–482.
14. Datta, A.; Ho, M.-T.; Bhattacharyya, S.P. Structure and Synthesis of PID Controllers; Springer Science & Business Media: Berlin/Heidelberg, Germany, 2000.
15. Johns, D.A.; Lewis, D.M. Design and analysis of delta-sigma based IIR filters. IEEE Trans. Circuits Syst. II Analog Digit. Signal Process. 1993, 40, 233–240.
16. Schreier, R. An empirical study of high-order single-bit delta-sigma modulators. IEEE Trans. Circuits Syst. II Analog Digit. Signal Process. 1993, 40, 461–466.
17. Kershaw, S.; Summerfield, S.; Sandler, M.; Anderson, M. Realisation and implementation of a sigma-delta bitstream FIR filter. IEE Proc. Circuits Devices Syst. 1996, 143, 267–273.
18. Johns, D.; Lewis, D. IIR filtering on sigma-delta modulated signals. Electron. Lett. 1991, 27, 307–308.
19. Stewart, B.; Pfann, E. Oversampling and sigma-delta strategies for data conversion. Electron. Commun. Eng. 1998, 10, 37–47.
20. Sklar, B. Digital Communications; Prentice Hall PTR: Upper Saddle River, NJ, USA, 2001; Volume 1099.
21. Reefman, D.; Janssen, E. One-bit audio: An overview. J. Audio Eng. Soc. 2004, 52, 166–189.
22. Dallago, E.; De Leo, G.; Sassone, G. A current-mode power sigma-delta modulator for audio applications. IEEE Trans. Ind. Electron. 2005, 52, 236–242.
23. Wu, X.; Goodall, R. One-bit processing for digital control. IEE Proc. Control Theory Appl. 2005, 152, 403–410.
24. Wu, X.; Goodall, R. One-Bit Processing for Real-Time Control; Loughborough University: Loughborough, UK, 2005.
25. Bai, X.; Wu, X. 1-Bit processing based model predictive control for fractionated satellite missions. Acta Astronaut. 2014, 95, 37–50.
26. Dong, Y.; Kraft, M.; Redman-White, W. Micromachined vibratory gyroscopes controlled by a high-order bandpass sigma-delta modulator. IEEE Sens. J. 2007, 7, 59–69.
27. Smith, T.; Nys, O.; Chevroulet, M.; DeCoulon, Y.; Degrauwe, M. A 15 b electromechanical sigma-delta converter for acceleration measurements. In Proceedings of the 1994 IEEE International Solid-State Circuits Conference (41st ISSCC), San Francisco, CA, USA, 16–18 February 1994; pp. 160–161.
28. Dong, Y.; Kraft, M.; Hedenstierna, N.; Redman-White, W. Microgyroscope control system using a high-order band-pass continuous-time sigma-delta modulator. Sens. Actuators A Phys. 2008, 145, 299–305.
29. Einicke, G.A. Smoothing, Filtering and Prediction-Estimating the Past, Present and Future; InTech: New York, NY, USA, 2012.
30. Zwahlen, P.; Nguyen, A.-M.; Dong, Y.; Rudolf, F.; Pastre, M.; Schmid, H. Navigation grade MEMS accelerometer. In Proceedings of the 2010 IEEE 23rd International Conference on Micro Electro Mechanical Systems (MEMS), Hong Kong, China, 24–28 January 2010; pp. 631–634.
31. Zwahlen, P.; Dong, Y.; Nguyen, A.-M.; Rudolf, F.; Stauffer, J.-M.; Ullah, P.; Ragot, V. Breakthrough in high performance inertial navigation grade Sigma-Delta MEMS accelerometer. In Proceedings of the 2012 IEEE/ION Position Location and Navigation Symposium (PLANS), Myrtle Beach, SC, USA, 23–26 April 2012; pp. 15–19.
32. Raman, J.; Cretu, E.; Rombouts, P.; Weyten, L. A digitally controlled MEMS gyroscope with unconstrained sigma-delta force-feedback architecture. In Proceedings of the 19th IEEE International Conference on Micro Electro Mechanical Systems (MEMS 2006), Istanbul, Turkey, 22–26 January 2006; pp. 710–713.
33. Petkov, V.P.; Boser, B.E. A fourth-order ΣΔ interface for micromachined inertial sensors. IEEE J. Solid-State Circuits 2005, 40, 1602–1609.
34. Hein, S.; Zakhor, A. On the stability of interpolative sigma delta modulators. In Proceedings of the IEEE International Sympoisum on Circuits and Systems, Singapore, 11–14 June 1991; pp. 1621–1624.
35. Hein, S.; Zakhor, A. On the stability of sigma delta modulators. IEEE Trans. Signal Process. 1993, 41, 2322–2348.
36. Wang, H. On the stability of third-order sigma-delta modulation. In Proceedings of the 1993 IEEE International Symposium on Circuits and Systems (ISCAS’93), Chicago, IL, USA, 3–6 May 1993; pp. 1377–1380.
37. Bourdopoulos, G.I.; Anastassopoulos, V.; Pnevmatikakis, A.; Deliyannis, T.L. Delta-Sigma Modulators Modeling, Design and Applications; Imperial College Press: London, UK, 2003.
38. Dunn, C.; Sandler, M. Use of clipping in Sigma-Delta modulators. In Proceedings of the IEEE Colloquium on Oversampling Techniques and Sigma-Delta Modulation, London, UK, 1–4 March 1994.
39. Steiner, P.; Yang, W. A framework for analysis of high-order sigma-delta modulators. IEEE Trans. Circuits Syst. II Analog Digit. Signal Process. 1997, 44, 1–10.
40. Almakhles, D.; Swain, A.; Patel, N. Stability and Performance Analysis of Bit-Stream Based Feedback Control Systems. IEEE Trans. Ind. Electron. 2015, 62, 4319–4327.
41. Kuhn, H.W.; Tucker, A.W. Nonlinear programming. In Proceedings of the Second Berkeley Symposium on Mathematical Statistics and Probability; University of California Press: Oakland, CA, USA, 1951; pp. 481–492.
42. Hildreth, C. A quadratic programming procedure. Nav. Res. Logist. Q. 1957, 4, 79–85.
43. Wang, L. Model Predictive Control System Design and Implementation Using MATLAB®; Springer: New York, NY, USA, 2009.
1Intelligent Space Systems Laboratory, School of Aerospace, Mechanical and Mechatronic Engineering, University of Sydney, Sydney, NSW 2006, Australia
2Centre for Quantum Technologies, National University of Singapore, Singapore 117543, Singapore
3School of Engineering, Sun Yat-sen University, Guangzhou 510275, China
*Author to whom correspondence should be addressed.
You have requested "on-the-fly" machine translation of selected content from our databases. This functionality is provided solely for your convenience and is in no way intended to replace human translation. Show full disclaimer
Neither ProQuest nor its licensors make any representations or warranties with respect to the translations. The translations are automatically generated "AS IS" and "AS AVAILABLE" and are not retained in our systems. PROQUEST AND ITS LICENSORS SPECIFICALLY DISCLAIM ANY AND ALL EXPRESS OR IMPLIED WARRANTIES, INCLUDING WITHOUT LIMITATION, ANY WARRANTIES FOR AVAILABILITY, ACCURACY, TIMELINESS, COMPLETENESS, NON-INFRINGMENT, MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE. Your use of the translations is subject to all use restrictions contained in your Electronic Products License Agreement and by using the translation functionality you agree to forgo any and all claims against ProQuest or its licensors for your use of the translation functionality and any output derived there from. Hide full disclaimer
© 2019. This work is licensed under https://creativecommons.org/licenses/by/4.0/ (the “License”). Notwithstanding the ProQuest Terms and Conditions, you may use this content in accordance with the terms of the License.
Abstract
In this paper, a bi-level Delta-Sigma modulator-based MEMS gyroscope design is presented based on a Model Predictive Control (MPC) approach. The MPC is popular because of its capability of handling hard constraints. In this work, we propose to combine the 1-bit nature of the bi-level Delta-Sigma modulator output with the MPC to develop a 1-bit processing-based MPC (OBMPC). This paper will focus on the affine relationship between the 1-bit feedback and the in-loop MPC controller, as this can potentially remove the multipliers from the controller. In doing so, the computational requirement of the MPC control is significantly alleviated, which makes the 1-bit MEMS Gyroscope feasible for implementation. In addition, a stable constrained MPC is designed, so that the input will not overload the quantizer while maintaining a higher Signal-to-Noise Ratio (SNR).
You have requested "on-the-fly" machine translation of selected content from our databases. This functionality is provided solely for your convenience and is in no way intended to replace human translation. Show full disclaimer
Neither ProQuest nor its licensors make any representations or warranties with respect to the translations. The translations are automatically generated "AS IS" and "AS AVAILABLE" and are not retained in our systems. PROQUEST AND ITS LICENSORS SPECIFICALLY DISCLAIM ANY AND ALL EXPRESS OR IMPLIED WARRANTIES, INCLUDING WITHOUT LIMITATION, ANY WARRANTIES FOR AVAILABILITY, ACCURACY, TIMELINESS, COMPLETENESS, NON-INFRINGMENT, MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE. Your use of the translations is subject to all use restrictions contained in your Electronic Products License Agreement and by using the translation functionality you agree to forgo any and all claims against ProQuest or its licensors for your use of the translation functionality and any output derived there from. Hide full disclaimer