Location via proxy:   [ UP ]  
[Report a bug]   [Manage cookies]                
Next Article in Journal
Infrared Sensor-Based Temperature Control for Domestic Induction Cooktops
Previous Article in Journal
A Constant Speed Changing Rate and Constant Turn Rate Model for Maneuvering Target Tracking
 
 
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

Research on the Signal Process of a Bell-Shaped Vibratory Angular Rate Gyro

1
School of Automation, Beijing Institute of Technology, Beijing 100084, China
2
Beijing Key Laboratory of High Dynamic Navigation Technology, Beijing Information Science & Technological University, Beijing 100101, China
*
Author to whom correspondence should be addressed.
Sensors 2014, 14(3), 5254-5277; https://doi.org/10.3390/s140305254
Submission received: 16 December 2013 / Revised: 5 February 2014 / Accepted: 7 February 2014 / Published: 13 March 2014
(This article belongs to the Section Physical Sensors)

Abstract

: A bell-shaped vibratory angular rate gyro, which is inspired by the Chinese traditional bell, is a kind of axisymmetric shell resonator gyroscope. Its sensitive element is a vibratory-like Chinese traditional bell, using a piezoelectric element on the wall of the vibrator to detect the standing wave's precession to solve the input angular rate. This work mainly studies the circuit system of a bell-shaped vibratory angular rate gyro. It discusses the process of circuit system design, analysis and experiment, in detail, providing the foundation to develop a bell-shaped vibratory angular rate gyro. Since the bell-shaped resonator's curved structure has the characteristics of large noise in the piezoelectric signal and large harmonics, this paper analyzes its working and signal detection method, then gives the whole plan of the circuit system, including the drive module, the detection module and the control loop. It also studies every part of the whole system, gives a detailed design and analysis process and proves part of the circuit system using digital simulation. At the end of the article, the test result of the circuit system shows that it can remove the disadvantages of the curved structure having large noise in the piezoelectric signal and large harmonics and is more effective at solving the input angular rate.

1. Introduction

The bell-shaped vibratory angular rate gyro (BVG) is a kind of solid wave gyro that detects the input angular rate using the standing wave's precession on a bell-shaped resonator. Its core component is a bell-shaped resonator-like millimeter-scale Chinese traditional bell. The resonator uses the exciting and detecting electrodes on its wall to control the resonator's mode to generate a special standing wave and extracts the precession to detect the angular rate. The method not only has the advantages of the traditional one, including low cost, low power consumption, longevity and highly sensitivity, but it also has a simple structure and good anti-impact performance, which could be better suited for low and medium velocity angular measurements [16].

BVG is based on traditional axisymmetric shell resonator gyroscopes, using the bell-shaped resonator's high quality vibration characteristics to make the resonator generate a standing wave. The literature [5,6] gives a detailed description on the design, analysis and experimentation of the bell-shaped vibratory angular rate gyro. On that basis, the prototype gyro has been developed and has a certain accuracy. The most important element for the gyro's performance is the design of the circuit system, including the whole structure, the design of the extracting signals and the control loop. Based on the circuit system of the bell-shaped vibratory angular rate gyro, the article describes the design process from theoretical analysis, simulation and experiments.

The work mode is four antinodes. It has two inherent stiff shaftings that can be orthogonal decomposed along 45°. Therefore, the axisymmetric shell resonator gyroscopes use a loop distribution of eight electrodes to make the electrodes be on every rigid axis. The traditional cylinder vibratory gyro, which drives electrodes and detects electrodes, uses piezoelectric ceramic material that is stuck to the cylinder's walls to collect signals using amplitude control, frequency control, orthogonal control and rate control to calculate the signals [79]. Based on that, Watson improved the precision of the gyroscope by adding two cracking inhibiting electrodes to control the piezoelectric axis effectively [9]. Innalab uses a two-grade column structure to improve the quality of standing waves, changes the position of the electrodes stuck to the cylinder's walls to the bottom and gets the input angular rate by four control loops. Right now, the cylinder vibratory gyros that the company has designed have been wildly used in the aerospace, robot control and vehicle navigation fields. Compared with the cylinder vibratory shell gyros, hemispheric resonant gyros have higher precision, because they use the method of non-contact driving detection and silica material as the harmonic oscillator [10,11]. However, it uses the same calculating method of four-loop control to finish the signal calculation [11]. For the complex process and high price, it has not been widely used in low-cost fields at this time.

BVG's driving and detecting electrodes are stuck to the resonator's wall like in cylindrical vibratory gyros. The disadvantages of bell-shaped vibratory angular rate gyros are the larger noise and more harmonic components of the complex surface. One can obtain standing waves of high quality through designing the structure of the bell-shaped resonator and improving the signals with the circuit system.

For the method of calculating signals, axisymmetric shell resonator gyroscopes and most existing vibratory gyroscopes, just like vibrating-beam gyroscopes, tuning fork gyroscopes and standard micro-mechanical gyroscopes, are all based on the classical four-loop control mode. According to the specific application, the loops are adjusted. The classical four loops include: amplitude control loop, frequency control loop, orthotropic control loop and rate control loop. The amplitude control loops and frequency control loops usually work together to make the mode shape stable. The orthotropic control loops and rate control loops work together. The orthotropic control loops are responsible for adjusting the mode shape and suppressing frequency cracking, and the rate control loops are responsible for extracting the input angular rate [7,1214]. In real applications, Coriolis vibratory gyros that use a second order derivative linear variable structure and classical four-loop control method cannot effectively estimate variable structure arguments. Many scholars have designed the control loops of these kinds of gyros with adaptive theory, sliding mode variable structure control theory and any other modern control theories to solve the problem [1517]. However, the inconveniences that using advanced control methods brings are the high requirement for signal calculating systems and the difficulty of operating the system. In practical engineering, studying the advanced control method is still ongoing and does not have detailed product application information.

Combining traditional vibratory gyros' electrical designing ideas with the characteristics of gyros, the article designs a circuit system of a BVG, including the driving components, detecting components and control loops. The BVG works in the force balance mode and uses classical four-loop control to make the mode shape stabilized. In chapter two, the BVG's working principle is described and the equivalent dynamic model is given. In chapter three, the whole design plan of the BVG for the signals' characteristics is given. Chapter four studies the circuit system's driving components, detecting components and control loops, discusses theory analysis, simulation verification and experimental testing and gives the detailed design and analysis process. In chapter five, an experiment is done to test the BVG's circuit system, to extract the input angular rate effectively and to prove its effectiveness and practicality.

2. Overview of Bell-Shaped Vibratory Angular Rate Gyro

The BVG is a kind of axisymmetric shell resonator gyroscope inspired by the traditional Chinese bell, and the core component is a bell-shaped resonator-like Chinese traditional bell. It uses the piezoelectric elements stuck to the resonator's wall to detect the standing waves' precession to calculate the input angular rate.

2.1. Work Principle

Bell-shaped vibratory angular rate gyros, using a piezoelectric ceramic electrode (PZT5A) stuck to the resonator's wall, drive the resonator to generate four antinodes vibration and generate stabilized standing waves. It measures the input angular rate by detecting the resonator's standing wave precession under the spinning condition [6]. The structure of the bell-shaped resonator is shown in Figure 1, including the bell-shaped resonator, piezoelectric elements and the isolate hole.

On the bell-shaped resonator's wall, there are eight electrodes, and there is an isolate hole between each one. The driving electrode uses the piezoelectric electrode's inverse piezoelectric effect to make the bell-shaped resonator generate standing waves. The detecting electrode uses the piezoelectric electrode's piezoelectric effect to detect the standing waves' vibration states. The angular rate Ω = 0 of the bell-shaped resonator vibrates steadily, as shown in Figure 2. The angular rate Ω ≠ 0, because of Coriolis effects, of the resonator's standing waves generate precession deviating from the original mode shape with an angle of ϑ. The BVG works in force balance mode, keeping the shape mode from generating precession by applying inverse torque, the value of which is proportional to the input angular rate. In [6], the detailed working process of the bell-shaped resonator is given, and so, it will not be introduced here.

2.2. Governing Equation of the Bell-Shaped Vibratory Angular Rate Gyro

The bell-shaped resonator has two vibratory orthogonalities with a difference of 45°. This means that the vibration can be an orthogonal decomposition and a composition along the angle of 45°, which is the reason for using eight discrete detecting electrodes. The electrode is fixed with a discrete distribution, and the mode shape is continuous and rotational, so that the detecting electrode cannot follow the antinodes. The working principle of the BVG is not the direct sensitive antinode's motion, but the sensitive orthogonal vibration and composition. In [6], it is proven that the bell-shaped vibratory angular rate gyro is equivalent to a classical Coriolis vibratory gyro, a two-dimensional spring particle motion model, as shown in Figure 3.

The xp axis that piezoelectric Electrodes 1 and 5 are on and the xn axis that Electrodes 3 and 7 are on form the x shafting. The yp axis that piezoelectric Electrodes 2 and 6 are on and the yn axis that Electrodes 4 and 8 are on form the y shafting. The bell-shaped resonator's standing wave vibration can be orthogonal decomposed along the x shafting and the y shafting. In the two-dimensional spring particle motion model, there is a constraint force, k, and damping force, d, on every axis. The x shafting is the oscillator. The Electrodes 1 and 5 supply the driving signals, and the Electrodes 3 and 7 detect the vibration on the x shafting. The y shafting is responsible for detecting the mode shape's deviation and for controlling the mode shape. The Electrodes 4 and 8 are on the wave node to detect the mode shape's deviating signals. The Electrodes 2 and 6 apply the damping moment to make the shape mode shift to the opposite direction. In Figure 3, dxn, dxp, dyn, dyp are the damping coefficients on the axis and kxn, kxp, kyn, kyp are the spring constants.

Using a similar system theory, we model the equivalent two-dimensional spring particle's control equation and also the BVG. There are many scholars that have performed studies on the kind of two-dimensional spring particle system and that have built control equations; the most typical one is [18]:

{ x ¨ 2 n η Ω y ˙ + ( 2 τ + Δ ( 1 τ ) cos 2 n θ τ ) x ˙ + Δ ( 1 τ ) sin 2 n θ τ y ˙ + ( ω 2 ω Δ ω cos 2 n θ ω ) x ω Δ ω sin 2 n θ ω y = f x y ¨ + 2 n η Ω x ˙ + ( 2 τ Δ ( 1 τ ) cos 2 n θ τ ) y ˙ + Δ ( 1 τ ) sin 2 n θ τ x ˙ + ( ω 2 + ω Δ ω cos 2 n θ ω ) y ω Δ ω sin 2 n θ ω x = f y
where η is the procession factor, fx is the driving force on the x-axis, fy is the driving force on the y-axis, Ω is the input angular rate along the axis, ωx is the driving modal frequency (the frequency of the x-axis), ωy is the detecting modal frequency (the frequency of the y-axis), θτ is the deviation angle on the driving axis, θω is the deviation angle on the damping axis and τx and τy are the reasonable time delay constants, ω 2 = ω x 2 + ω y 2 2, ω Δ ω = ω x 2 ω y 2 2, 1 τ = 1 2 ( 1 τ x + 1 τ y ), Δ ( 1 τ ) = ( 1 τ x 1 τ y ).

For Figure 3, the corresponding control model is:

{ x ¨ 2 n η Ω y ˙ + ( d x n + d x p ) x ˙ + d x y y ˙ + ( k x n + k x p ) x + k x y y = f x y ¨ + 2 n η Ω x ˙ + d y x x ˙ + ( d y n + d y p ) y ˙ + k y x x + ( k y n + k y p ) y = f y
where dxy and dyx are the interference dampings between the two shaftings. kxy and kyx are the interference spring factors between the two shaftings. d x n + d x p = 2 τ + Δ ( 1 τ ) cos 2 n θ τ, kxn + kxp = ω2ωΔω cos 2ω, fx = fp1 + fp2, d y n + d y p = 2 τ Δ ( 1 τ ) cos 2 n θ τ, kyn + kyp = ω2 + ωΔω cos 2ω, fy = fy1 + fy2, d x y = d y x = Δ ( 1 τ ) sin 2 n θ τ, kxy + kyx = −ωΔω sin 2ω.

Above all, we know the control object of the BVG and can design the circuit system for the control object.

3. Design Process

Knowing the working principle and control equations, the following is the design of the circuit system. Based on the whole electrical design plan, it is divided into three parts: driving components, detecting components and control loops.

3.1. The Whole Design Plan of the Circuit System

The Electrodes 1 and 5 in the x shafting are the driving electrodes. The sinusoidal signal with the frequency of the bell-shaped resonator's natural frequency makes the resonator vibrate. The driving signal is directly generated from DSPwith the Direct Digital Synthesis (DDS) algorithm and is applied on Electrodes 1 and 5 with DAC. DDS also supplies the exact modulating signal for calculating the amplitude and phase. It calculates the resonator's vibration by detecting Electrodes 3 and 7. By designing amplitude loop controller GA and frequency loop controller GF, dynamically adjusting DDS can make the bell-shaped resonator generate resonance. Detecting the Electrodes 4 and 8 on the y shafting, analyzing the standing wave's procession, designing rate loop controller GR and quadrature loop controller GQ, dynamically adjusting the damping torque on Electrodes 2 and 6 makes the gyro work in the force balance mode and leaves the mode shape unchanged. At the same time, the output of the controller in the rate control loop is proportional to the input angular rate. The whole signal flow is shown in Figure 4.

For the circuit system's hardware application, the control loops and DDS signals are generated from DSP. The signal collecting is done by DAC. The piezoelectric electrodes' driving and detecting use the analog conditioning circuit. In the real circuit system, we use the STM32F405 as the DSP chip, DSP to supply ADCand AD5328 as the DAC chip. The core component of the analog conditioning circuit is AD8676.

Above all, we divide the whole circuit system into three parts, including the driving components, detecting components and control loops. The driving components include designing the DDS algorithm and conditioning the piezoelectric electrodes' driving signal. The detecting components include the conditioning piezoelectric electrodes' small output signals and calculating the amplitude and phase. The control loops includes the amplitude control loop, frequency control loop, rate control loop and quadrature control loop. For the hardware application, the whole circuit system is divided into three parts: power circuit, signal preprocess circuit and signal process circuit. The power circuit supplies power for the whole circuit system, in which the signal process circuit system uses ±15 V and the signal calculating circuit uses 5 V. The whole structure of the circuit system is shown in Figure 5.

3.2. The Design of the Driving Components

The driving components include two parts: the bell-shaped driving electrode circuit and the bell-shaped vibratory damping electrode circuit. In the two circuits, the main point is to design the DDS and signal conditioning system.

3.2.1. Direct Digital Synthesis (DDS)

The DDS part of the BVG circuit system is produced by DSP, which generates the vibratory signals to make the resonator work. The DDS also supplies the sine and cosine signals for the linear demodulator for calculation. The chosen DSP's work frequency is 200 MHz, and the generated DDS's reference clock is 100 kHz. The DDS generates the sine signal with a frequency between 5,000 and 9,000 Hz. We use the classical look-up table algorithm to generate DDS with an adder of 30 bits and phase truncation of 12 bits.

3.2.2. Signal Conditioning System

The DDS generated by DSP in the signal process circuit is sent to the DAC chip. The output of DAC is a sine signal with amplitude of 0–5 V and a bias of 2.5 V. Its reference frequency is 100 kHz. The signal process circuit sends the signal to the signal preprocessing circuit. The preprocessing circuit will adjust the bias and amplify and filter the signal to change it from −10 V to a sine signal with +10 V and a bias of 0 V and send it to the driving electrode. The damping circuit is the same as the flow, but the sine signal is sent from DAC. Besides, the designed filter needs to remove the noise with a high frequency. According to the frequency characteristics of the bell-shaped resonator and the reference frequency of DDS, the designed low-pass filter's cutoff frequency is 20 kHz; it can effectively remove the high harmonics generated by DDS's reference frequency. The whole structure of the signal conditioning system is shown in Figure 6.

In the conditioning system, we add a filter amplifying circuit to meet the condition of R 4 R 1 = R 3 R 2, and the relationship between inputs and outputs in the pass-band of low-pass filter is:

u dout = R 4 R 1 ( u din u d f )

The added filter capacity is the designed DDS low-pass filter capacity. The driving components are equivalent to the following control structure frame, as shown in Figure 7.

Additionally, the driving components' transfer function is:

G D ( s ) = R 4 / R 1 R 4 C 1 s + 1 u d f

According to the signal and characteristics in Figure 6, the gain is four, and the value of the arguments is: R4 = R3 = 40 kΩ, R2 = R1 = 10 kΩ, C1 = 0.2 μf. Additionally, the frequency is as shown below. For the output resistance, R5 is used to match the driving electrode and the damping electrode, and the value is 1 kΩ. The input DDS's null voltage is udf = 2.5 V. We use the AD8676 PSPICE model produced by ADI company (Dallas, TX, USA) to do PSPICE simulation; the real cutoff frequency is 20.33 kHz, and the cutoff phase is −34.64°. The simulation result is shown in Figure 8.

3.3. Design of the Detecting Components

3.3.1. Small Signal Extracting System

The small signal extracting system mainly collects the signals of the feedback electrodes (piezoelectric Electrodes 3 and 7) and the detecting electrodes (piezoelectric Electrodes 4 and 8). The voltage of the two groups of electrodes' amplitude is usually around 20 mV; the deviation relates to the input angular rate. In the real design, because of range of the ADC's input voltage we use is zero to 3.3 V, we need to filter, amplify and adjust the deviation. For the bell-shaped resonator's surface, the electrodes do not contact the wall fully; they will generate noise of high frequency. We design a low-pass filter to restrain the noise. According to the vibratory frequency of the bell-shaped resonator, the low-pass filter must have a cutoff frequency that is more than two times that of the natural frequency of the bell-shaped resonator. Therefore, we choose the filter with a cutoff frequency about 20 kHz. The whole circuit structure is shown in Figure 9.

In the detecting components, firstly, the signal should pass a filter amplifying process to remove the high frequency vibratory noise, and then, it should be adjusted to meet the requirement for the ADC to sample. To meet the requirement of signal conditioning, we choose R 14 R 12 = R 13 R 11; the relation between inputs and outputs for a circuit in low-pass filter's pass-band is:

u sout = R 14 R 12 ( 15 R 10 R 9 + R 10 + R 8 R 6 u sin )
where adjusting the ratio of R10 to R9 can change the output signal's zero position. Adjusting the ratio of R14 to R12 or R8 to R6 can change the amplitude of the output signal. For the small signal extracting system in the detecting components, the hardware control structure frame is shown in Figure 10.

In the real design, considering that the output signal's amplitude is around 20 mV, we choose the amplification factor as 50, that is: R8 = 50 kΩ, R6 = 1 kΩ, R14 = R13 = 1 kΩ, R12 = R11 = 1 kΩ, C2 = 0.1nf, R 9 R 9 + R 10 = 0.1. We use the AD8676 PSPICE of ADI company to do PSpice simulation. The real cutoff frequency is 28.43 kHz and the cutoff phase −45.37°, and the result of the simulation is shown in Figure 11.

3.3.2. Calculating Amplitude and Phase

For the output signals of the detecting electrodes and feedback electrodes, we need to calculate the amplitude and phase. In the circuit system of the bell-shaped vibratory angular rate gyro, we use linear demodulation for the calculation [19]. The detailed process is, assuming the output signal on the x-axis: S = Ax sin (ωxt + φd), where φd is the whole phase. Using the signal generated by DDS as the demodulation signal, we multiply and filter the output signals to get the in-phase component, xd, and quadrature component, yd. The detailed process is:

x d = LPF ( S sin ( ω x t ) ) = LPF { A x 2 [ cos ( 2 ω x t + φ d ) cos φ d ] } = A x 2 cos φ d
y d = LPF ( S cos ( ω x t ) ) = LPF { A x 2 [ sin ( 2 ω x t + φ d ) + cos φ d ] } = A x 2 sin φ d
where LPF{•} means low-pass filter. We can get the linear demodulation result using trigonometry functions.
A x = 2 x d 2 + y d 2 φ d = arctan ( y d x d )

In the real circuit system, we choose the classical FIRfilter as the linear demodulation's low-pass filter. In the calculating process, the sampling frequency of DSP is 100 kHz. The working frequency of the bell-shaped vibratory angular rate gyro is between six and 8 kHz. The designed digital low-pass filter's cutoff frequency is 100 Hz [6].

3.4. The Design of Control Loops

In Equation (2), the general governing equation of the BVG is given. Based on this and the gyro's working mode, we will design the gyro's control loops. The gyro uses the force balancing mode, and the control loop algorithm is applied by DSP. Using the ADC to collect the signals of the detecting electrodes and feedback electrodes from the detecting components, through the control loop algorithm, to the DAC adjusting signals are output, through the driving components, and control the resonator's mode shape. The control loop uses the classical four-loop control, where the amplitude control and frequency control is responsible for the stability of the resonator, and the quadrature control and rate control is responsible for the mode shape of the resonator and calculating the input angular rate [20,21].

3.4.1. Choosing The System Parameters

For the governing equation of the bell-shaped vibratory angular rate gyro given by Equation (2), the control system's structure frame is shown in Figure 12.

Adding different inputs and outputs using experiments can obtain the parameters in system. The standard methods are the frequency domain method and time domain method. We will not describe the detailed processes, which [2124] can for the reader's reference. In the article, the specific bell-shaped vibratory angular rate gyro's detailed parameters are in Table 1.

3.4.2. Amplitude Control Loop and Frequency Control Loop

The amplitude control loop and frequency control loop are mainly designed for the x-axis. To stabilize the bell-shaped resonator at anytime, the motion on x can be thought of as a standard two-order system with disturbance; the disturbance signal is the output of the y-axis and the input angular rate from the outside. The dynamic equation is:

x ¨ + ( d x n + d x p ) x ˙ + ( k x n + k x p ) x = f x r x
where the disturbance signal is: rx = (−2 + dxy) + kxyy.

Under no disturbance, the transfer function of the bell-shaped resonator along the x-axis is:

G x ( s ) = x f x = 1 s 2 + ( d x n + d x p ) s + ( k x n + k x p )

There are many scholars that have studied this kind of standard vibratory function. The results show that when the resonator is working in the resonant state, the gyro's vibratory signal, xn, phase lags behind the driving signal, fx, and the difference is 90° [1113].

The transfer function only with disturbance is:

G r x ( s ) = x y = ( 2 n η Ω + d x y ) s + k k y s 2 + ( d x n + d x p ) s + ( k x n + k x p )

Because the input angular rate is a nonlinear variable, in the x-axis control loop, the disturbance brought by vibration on the y-axis is also nonlinear. The disturbance can bring errors for control in the x-axis. When increasing the damping moment, The vibration in the y-axis will decrease and, finally, be zero, and the disturbance will disappear. For the tight coupling system, we use the adaptive PIcontroller. We adjust the controller's parameters and choose the right control bandwidth to lower the disturbance signal.

Adding the driving components and detecting components, the whole control loop of the x-axis is shown in Figure 13. The output is the DDS digital signal that DSP produces; the input is the digital signal the ADC collected, and we use DSP to make the controller. The digital signal DSP output goes through the driving components, drives the x-axis's driving electrodes with two parts, detects the x-axis's two detecting electrodes with the detecting components and performs the difference process. The controller detects the vibratory signals in the xp-axis, calculates the amplitude and phase of the signal, calculates the control error with the given amplitude and phase, designs the amplitude controller and frequency controller and real-time adjusts DDS's output. In Figure 13, the driving components and detecting components use resistors of the same value for different electrodes in order to describe them conveniently, and there is no detailed information.

After adding the driving components and detecting components, the phase controller controls need to be changed. In the whole system, the aim of controlling the phase is to make the gyro have a phase of 90 degrees. Therefore, controlling the phase will let other the components' phases change; the phase is:

G phase ( s ) = R 4 / R 1 R 4 C 1 s + 1 R 8 / R 6 R 8 C 2 s + 1

The phase can dynamically adjust the controller's reference phase value.

3.4.3. Quadrature Control Loop and Rate Control Loop

The quadrature control loop and rate control loop are mainly designed for the y-axis. The aim is to make the bell-shaped resonator's mode shape have no procession, that is to make the output in the y-axis be zero. The quadrature control is to make the x-axis and the y-axis have the same phase. The rate control is to make the output's amplitude on the y-axis be zero. The motion on the y-axis can also be thought of as a standard two-order system with disturbance; the disturbance signal is an output in the x-axis and the input angular rate from the outside. The dynamic function is:

y ¨ + ( d y n + d y p ) y ˙ + ( k y n + k y p ) y = f y r y
where the disturbance signal is: ry = (2 + dyx) + kyxy.

Under no disturbance, the transfer function of the bell-shaped resonator along the y-axis is:

G y ( s ) = y f y = 1 s 2 + ( d y n + d y p ) s + ( k y n + k y p )

The transfer function only with disturbance is:

G r y ( s ) = y x = ( 2 n η Ω + d y x ) s + k y x s 2 + ( d y n + d y p ) s + ( k y n + k y p )

Furthermore, we need to design an anti-disturbance adaptive filter to remove the influence that the vibration in the x-axis brings to the y-axis. For the adaptive PI controller, the parameters of filter need to be adjusted with the calculated angular rate to rapidly remove the disturbance that the vibration in the x-axis brings.

In practice, the implemented method is similar to the x-axis. The rate control loop's output is proportional to the input angular rate to calculate the input angular rate [13,25], as shown in Figure 14.

3.4.4. Control Strategy Analysis

The premise for the system to work is that the resonator is working in the resonant situation, and the amplitude of the vibration is constant. The control loops of the resonator are coupled to each other. In order to get the best control results of any loops, we need to design a reasonable loop control strategy.

After initialing the system, DSP samples the ADC synchronously, collects the signals of the x-axis (piezoelectric Electrodes 3 and 7) and the y-axis (piezoelectric Electrodes 4 and 8), goes through linear demodulation and calculates the corresponding amplitude and phase. With this information, we calculate the four loops, combine the results and output DAC to the driver. Now, the multi-loops can work together. We can sample and output at the same time. In the control period, we can calculate every loop's information. The control workflow is shown in Figure 15 [19].

4. Simulation and Experiment

The designed circuit system is divided into three parts: signal preprocess circuit, signal process circuit and power circuit. In [6] is given real pictures of the circuit system and the bell-shaped resonator.

4.1. Simulation of the Control Loop

In practice, DDS's reference clock is 100 kHz, the output clock of DAC 100 kHz, the sampling frequency of ADC 1 MHz and the control cycle of the control system 5 ms. The simulation parameters of the gyro system are shown in Table 1; the parameters of the driving components and detecting components can be found in other chapters. We use MATLAB to simulate the bell-shaped vibratory angular rate gyro's control loops. The simulation results of the loops can be found in [20]; the article only gives the simulation result of the whole control system. In the simulation process, there is no driving component nor detecting components. It just verifies the gyro and the controller's design method.

When the input angular rate is zero, that is Ω = 0 (no control loops), there is only driving in the x-axis. The output result is shown in Figure 16. After adding four control loops, the actual output is shown in Figure 17. From Figure 16, we notice that the resonator is under the non-control condition. The output amplitude in the x-axis and the y-axis are all vibratory, and the convergence is slow. The output in the y-axis is influenced by the output in the x-axis and has a certain degree of coupling. The output amplitude in the y-axis is 6 mV. In Figure 17, for adding control loops, the output in the x-axis can stabilize after 8 s, and the output amplitude in the y-axis 0.02 mV, near 0 V. In practice, 0.02 mV is too small of a signal to recognize, so it can be thought of as 0 V. The output amplitude in the y-axis is not the standard 0 V and relate to the precision and the restraining method used.

When the input angular rate is a specific square wave, there is a non-control loop. The output in the x-axis and y-axis is shown in Figure 18. The output in the x-axis is influenced by the input angular rate, the amplitude and the phase change, and the vibration is not stabilized. With the existing input angular rate, the standing wave precess, the output in the x-axis also changes and reaches the steady state with the existing angular rate. In Figure 18, the output in the x-axis and y-axis is converging at every state when the angular rate changes. Figure 19 gives several situations. At 0–2 s, the angular rate is 0. The gyro starts to work, and the x-axis starts to vibrate; however, in the period, the vibration is not stabilized, but has the trend of becoming stabilized. The process repeats with the angular rate's change, but the output in the x-axis and y-axis is consistent. The gyro is working in the open loop mode, and the bandwidth is low. After adding the control loop, as shown in Figure 19, the control loops get stabilized after 8 s. The gyro can do normal work. The output in the x-axis and y-axis does not get influenced by the angular rate, and the mode shape remains the same. However, with the existing error, we notice that there is some amplitude changes when there is any angular rate in the x-axis and y-axis, but the amplitude is very small; the maximum amplitude in the y-axis is only 0.4 mV and, so, can be ignored in the real system. The angular rate calculated by the rate control loops is shown in Figure 20.

When the input is a sine signal with an angular rate of 1 Hz, an amplitude of 300 deg/s and there is non-control, the output in the two shaftings is as shown in Figure 21. The output in the two shaftings is influenced by the angular rate. After adding control loops, the output in the x-axis is always steadily vibratory. The maximum output in the y-axis is 0.6 mV, which can be ignored, as shown in Figure 22. The angular rate calculated by the angular control loops is shown in Figure 23. We can find that it can follow the input angular rate.

4.2. Driving Components Test

We test the driving components with a Tektronix TDS3032B oscillograph. The signal process circuit uses the DAC to output the DDS's original signal with high frequency noise, which is the yellow curve in Channel 1 in Figure 24. After the driving components, the output is the FFT, which is the red curve in Channel 2 in Figure 24. We can find that the high order harmonic wave has been removed, and the voltage meets the designed requirement.

4.3. Detecting Components Test

The detecting components use the piezoelectric Electrode 3 to test. We add the driving signals that the driving components generate to piezoelectric Electrodes 1 and 5. The output of piezoelectric Electrode 3 is Channel 2 with the blue curve in Figure 25. It has much noise and many high order harmonic waves. After the detecting components, the output is the yellow curve shown in Channel 1 in Figure 25. We can see that the high order harmonic waves have been removed. The signals are in the collected range of the ADC and meet the design requirements.

4.4. Gyro Test

Using the designed electrical system to test the bell-shaped vibratory angular rate gyro, the output angular rate results are shown in Figure 26. We can see that the gyro is close-loop controlled and can get the input angular rate effectively. However, the electrical system, the linearity, random walk, scale factor stability and zero stability are all in need of being improved. The paper mainly studies the design and analysis process and will give the detailed performance in papers to follow.

5. Conclusions

The bell-shaped vibratory angular rate gyro, which is inspired by the Chinese traditional bell, is a kind of axisymmetric shell resonator gyroscope. Its sensitive element is a vibratory-like Chinese traditional bell, using the piezoelectrical element on the wall of the vibrator to detect the standing wave's precession to solve the input angular rate. This paper mainly studies the signal process of the bell-shaped vibratory angular rate gyro. It discusses the process of the electrical system design, analysis and experiment in detail, providing the foundation to develop the BVG. The designed driving components can supply reasonable driving signals to stabilize the bell-shaped resonator. The detecting components can solve the disadvantages that the bell-shaped resonator's curved surface brings, like the piezoelectric signals' large noise and the harmonic waves' many components. It can effectively change the output signal to the signal process circuit. The control loop can effectively control the bell-shaped resonator's mode shape and calculate the angular rate. However, for detailed performance, it still needs a lot of study and experimentation, including the stability of the DDS output signals, the choice and design of the controller, the hardware structure's rationalization and improving the detailed index. The authors will perform more studies on the mentioned problems in the future.

Acknowledgments

This work is supported by the National Nature Science Foundation under Grant 61031001; 40405100304 and 9071223301. Supported by the Beijing Key Laboratory of High Dynamic Navigation Technology.

Author Contributions

Zhong Su and Ning Liu conceived and designed the study. Zhong Su, Ning Liu, Qing Li, Mengyin Fu, Hong Liu and Junfang Fan performed the experiments. Ning Liu provided the simulation. Zhong Su, Ning Liu and Hong Liu wrote the paper. Qing Li, Mengyin Fu and Junfang Fan reviewed and edited the manuscript. All authors read and approved the manuscript.

Conflicts of Interest

The authors declare no conflict of interest.

References

  1. Matveev, V.; Basarab, M. Solid State Wave Gyro; National Defense Industry Press: Beijing, China, 2009. [Google Scholar]
  2. Hopkin, I.D.; Fell, C.P.; Townsend, K.; Mason, T.R. Vibrating Structure Gyroscope US Patent 5932804, 3 August 1999.
  3. Singh, A. Piezoelectric gyro sensor technology. Def. Sci. J. 2007, 57, 95–103. [Google Scholar]
  4. Burdess, J.; Harris, A.; Cruickshank, J.; Wood, D.; Cooper, G. A review of vibratory gyroscopes. Eng. Sci. Educ. J. 1994, 3, 249–254. [Google Scholar]
  5. Zhong, S.; Mengyin, F.; Qing, L.; Ning, L.; Hong, L. Research on bell-shaped vibratory angular rate gyro's character of resonator. Sensors 2013, 13, 4724–4741. [Google Scholar]
  6. Ning, L.; Zhong, S.; Qing, L.; Mengyin, F.; Hong, L.; Junfang, F. Characterization of the bell-shaped vibratory angular rate gyro. Sensors 2013, 13, 10123–10150. [Google Scholar]
  7. Loveday, P.W. Analysis and Compensation of Imperfection Effects in Piezoelectric Vibratory Gyroscopes. Ph.D. Thesis, Virginia Polytechnic Institute and State University, Blacksburg, VA, USA, February 1999. [Google Scholar]
  8. Ting, Y.; Huang, J.S.; Huang, J.L.; Yang, C.M. Effect of polarized electric field on piezoelectric cylinder vibratory gyroscope. Sens. Actuators A Phys. 2006, 128, 248–256. [Google Scholar]
  9. Singh, A. Vibrating structure piezoelectric hollow cylinder gyroscope. Ind. J. Eng. Mater. Sci 2005, 12, 7–11. [Google Scholar]
  10. Rozelle, D.M. The Hemispherical Resonator Gyro: From Wineglass to the Planets. Proceedings of the 19th AAS/AIAA Space Flight Mechanics Meeting, Savannah, Georgia, 8–12 February 2009; pp. 1157–1178.
  11. Shatalov, M. General Problems of Dynamics and Control of Vibratory Gyroscopes. Proceedings of the Solid State Gyroscopy International Anniversary Workshop, Yalta, Ukraine, 19–21 May 2008.
  12. Chikovani, V.; Yatsenko, Y.A.; Barabashov, A.; Marusyk, P.; Umakhanov, E.; Taturin, V. Improved accuracy metallic resonator CVG. IEEE Aerosp. Electron. Syst. Mag. 2009, 24, 40–43. [Google Scholar]
  13. Tao, Y.; Wu, X.; Xiao, D.; Wu, Y.; Cui, H.; Xi, X.; Zhu, B. Design, analysis and experiment of a novel ring vibratory gyroscope. Sens. Actuators A Phys. 2011, 168, 286–299. [Google Scholar]
  14. Leland, R.P. Adaptive Tuning for Vibrational Gyroscopes. Proceedings of the 40th IEEE Conference on IEEE Decision and Control, Orlando, FL, USA; 2001; 4, pp. 3447–3452. [Google Scholar]
  15. Batur, C.; Sreeramreddy, T.; Khasawneh, Q. Sliding mode control of a simulated MEMS gyroscope. ISA Trans. 2006, 45, 99–108. [Google Scholar]
  16. Yan, W.; Fei, J. Adaptive control of MEMS gyroscope based on global terminal sliding mode controller. Math. Probl. Eng. 2013, 2013, 797626:1–797626:9. [Google Scholar]
  17. Lynch, D. Vibratory Gyro Analysis by the Method of Averaging. Proceedings of the 2nd Saint Petersburg Conference on Gyroscopic Technology and Navigation, St. Petersburg, FL, USA, 24–25 May 1995; pp. 26–34.
  18. Xie, D.; Wu, X.; Tao, Y.; Zhou, Z.; Li, H. The study on sinusoidal high stability drive technology of cupped wave gyro. Chin. J. Sens. Actuators 2011, 12. [Google Scholar] [CrossRef]
  19. Ning, L.; Zhong, S.; Hong, L. Research on the Control Loop for Solid Vibratory Gyroscope. Proceedings of the 2013 32nd Chinese IEEE Control Conference (CCC), Xi'an, China, 26–28 July 2013; pp. 4963–4968.
  20. IEEE Standard Specification Format Guide and Test Procedure for Coriolis Vibratory Gyros; IEEE Std 1431-2004; Institute of Electrical and Electronics Engineers: New York, NY, USA, 2004; pp. 1–78.
  21. Chen, F.; Yuan, W.; Chang, H.; Yuan, G.; Xie, J.; Kraft, M. Design and implementation of an optimized double closed-loop control system for MEMS vibratory gyroscope. Sens. J. IEEE 2014, 14. [Google Scholar] [CrossRef]
  22. Jin, J.; Rhee, H. Development of LabVIEW Programs for Simulating Resonator Gyros. Proceedings of the 2011 11th International Conference on IEEE Control, Automation and Systems (ICCAS), Gyeonggi-do, Korea, 26–29 October 2011; pp. 1735–1737.
  23. Apostolyuk, V. Dynamics of coriolis vibratory gyroscopes in control systems. Syst. Control Navig. Commun. 2010, 13, 62–66. [Google Scholar]
  24. Shatalov, M.; Lunin, B. Vibratory Gyroscopes: Identification of Mathematical Model from Test Data. Proceedings of the 14th International Conference on Integrated Navigational Systems (ICINS), St. Petersburg, Russia, 28–30 May 2007.
  25. Chikovani, V.; Okon, I.; Barabashov, A.; Tewksbury, P. A Set of High Accuracy Low Cost Metallic Resonator CVG. Proceedings of the 2008 IEEE/ION. IEEEP on Position, Location and Navigation Symposium, Monterey, CA, USA, 5–8 May 2008; pp. 238–243.
Figure 1. The schematic of the bell-shaped resonator's structure.
Figure 1. The schematic of the bell-shaped resonator's structure.
Sensors 14 05254f1 1024
Figure 2. The schematic of the working principle. (a) Primary Mode; (b) Second Mode.
Figure 2. The schematic of the working principle. (a) Primary Mode; (b) Second Mode.
Sensors 14 05254f2 1024
Figure 3. The equivalent vibratory model of the bell-shaped resonator.
Figure 3. The equivalent vibratory model of the bell-shaped resonator.
Sensors 14 05254f3 1024
Figure 4. The circuit system signal flow.
Figure 4. The circuit system signal flow.
Sensors 14 05254f4 1024
Figure 5. The structure of the circuit system.
Figure 5. The structure of the circuit system.
Sensors 14 05254f5 1024
Figure 6. The signal conditioning system of the driving component.
Figure 6. The signal conditioning system of the driving component.
Sensors 14 05254f6 1024
Figure 7. The structure frame of the signal conditioning system in the driving component.
Figure 7. The structure frame of the signal conditioning system in the driving component.
Sensors 14 05254f7 1024
Figure 8. The Bode plot of the signal conditioning system in the driving components.
Figure 8. The Bode plot of the signal conditioning system in the driving components.
Sensors 14 05254f8 1024
Figure 9. The small signal extracting system in the detecting components.
Figure 9. The small signal extracting system in the detecting components.
Sensors 14 05254f9 1024
Figure 10. The small signal extracting system structure frame in the detecting components.
Figure 10. The small signal extracting system structure frame in the detecting components.
Sensors 14 05254f10 1024
Figure 11. The Bode plot of the small signal extracting system in the driving components.
Figure 11. The Bode plot of the small signal extracting system in the driving components.
Sensors 14 05254f11 1024
Figure 12. The Bode plot of the small signal extracting system in the driving components.
Figure 12. The Bode plot of the small signal extracting system in the driving components.
Sensors 14 05254f12 1024
Figure 13. The structure frame of the x-axis control loop.
Figure 13. The structure frame of the x-axis control loop.
Sensors 14 05254f13 1024
Figure 14. The structure frame of the y-axis control loop.
Figure 14. The structure frame of the y-axis control loop.
Sensors 14 05254f14 1024
Figure 15. The flow of the control strategy.
Figure 15. The flow of the control strategy.
Sensors 14 05254f15 1024
Figure 16. The gyro's output with non-control in Ω = 0.
Figure 16. The gyro's output with non-control in Ω = 0.
Sensors 14 05254f16 1024
Figure 17. The gyro's output with control in Ω = 0.
Figure 17. The gyro's output with control in Ω = 0.
Sensors 14 05254f17 1024
Figure 18. The gyro's output with non-control in Ω is the sine signal.
Figure 18. The gyro's output with non-control in Ω is the sine signal.
Sensors 14 05254f18 1024
Figure 19. The gyro's output with control in Ω is square.
Figure 19. The gyro's output with control in Ω is square.
Sensors 14 05254f19 1024
Figure 20. The calculated angular rate output with control in Ω is square.
Figure 20. The calculated angular rate output with control in Ω is square.
Sensors 14 05254f20 1024
Figure 21. The gyro's output with non-control in Ω is the sine signal.
Figure 21. The gyro's output with non-control in Ω is the sine signal.
Sensors 14 05254f21 1024
Figure 22. The gyro's output with control in Ω is square.
Figure 22. The gyro's output with control in Ω is square.
Sensors 14 05254f22 1024
Figure 23. The calculated angular rate output with control in Ω is square.
Figure 23. The calculated angular rate output with control in Ω is square.
Sensors 14 05254f23 1024
Figure 24. The output of the driving components.
Figure 24. The output of the driving components.
Sensors 14 05254f24 1024
Figure 25. The output of the detecting components.
Figure 25. The output of the detecting components.
Sensors 14 05254f25 1024
Figure 26. The output of the bell-shaped vibratory angular rate gyro.
Figure 26. The output of the bell-shaped vibratory angular rate gyro.
Sensors 14 05254f26 1024
Table 1. The system's parameters.
Table 1. The system's parameters.
ParametersValue
Control Time (ms)5
ωx (Hz)6,635.6
ωy (Hz)6,635.1
τx15.7
τy16.8
θω (deg)2.5
θω (deg)1.8
K0.37

Share and Cite

MDPI and ACS Style

Su, Z.; Liu, N.; Li, Q.; Fu, M.; Liu, H.; Fan, J. Research on the Signal Process of a Bell-Shaped Vibratory Angular Rate Gyro. Sensors 2014, 14, 5254-5277. https://doi.org/10.3390/s140305254

AMA Style

Su Z, Liu N, Li Q, Fu M, Liu H, Fan J. Research on the Signal Process of a Bell-Shaped Vibratory Angular Rate Gyro. Sensors. 2014; 14(3):5254-5277. https://doi.org/10.3390/s140305254

Chicago/Turabian Style

Su, Zhong, Ning Liu, Qing Li, Mengyin Fu, Hong Liu, and Junfang Fan. 2014. "Research on the Signal Process of a Bell-Shaped Vibratory Angular Rate Gyro" Sensors 14, no. 3: 5254-5277. https://doi.org/10.3390/s140305254

APA Style

Su, Z., Liu, N., Li, Q., Fu, M., Liu, H., & Fan, J. (2014). Research on the Signal Process of a Bell-Shaped Vibratory Angular Rate Gyro. Sensors, 14(3), 5254-5277. https://doi.org/10.3390/s140305254

Article Metrics

Back to TopTop