Next Article in Journal
A Novel Component Carrier Configuration and Switching Scheme for Real-Time Traffic in a Cognitive-Radio-Based Spectrum Aggregation System
Next Article in Special Issue
GPS Cycle Slip Detection Considering Satellite Geometry Based on TDCP/INS Integrated Navigation
Previous Article in Journal
Commercial Motion Sensor Based Low-Cost and Convenient Interactive Treadmill
Previous Article in Special Issue
An SINS/GNSS Ground Vehicle Gravimetry Test Based on SGA-WZ02
 
 
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

Error Model and Compensation of Bell-Shaped Vibratory Gyro

1
School of Automation, Beijing Institute of Technology, Beijing 100081, 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 2015, 15(9), 23684-23705; https://doi.org/10.3390/s150923684
Submission received: 19 June 2015 / Revised: 27 August 2015 / Accepted: 7 September 2015 / Published: 17 September 2015
(This article belongs to the Special Issue Inertial Sensors and Systems)

Abstract

:
A bell-shaped vibratory angular velocity gyro (BVG), inspired by the Chinese traditional bell, is a type of axisymmetric shell resonator gyroscope. This paper focuses on development of an error model and compensation of the BVG. A dynamic equation is firstly established, based on a study of the BVG working mechanism. This equation is then used to evaluate the relationship between the angular rate output signal and bell-shaped resonator character, analyze the influence of the main error sources and set up an error model for the BVG. The error sources are classified from the error propagation characteristics, and the compensation method is presented based on the error model. Finally, using the error model and compensation method, the BVG is calibrated experimentally including rough compensation, temperature and bias compensation, scale factor compensation and noise filter. The experimentally obtained bias instability is from 20.5°/h to 4.7°/h, the random walk is from 2.8°/h1/2 to 0.7°/h1/2 and the nonlinearity is from 0.2% to 0.03%. Based on the error compensation, it is shown that there is a good linear relationship between the sensing signal and the angular velocity, suggesting that the BVG is a good candidate for the field of low and medium rotational speed measurement.

1. Introduction

The vibratory gyroscope is a specialized branch of the gyro research field, which is gaining more attention from researchers [1,2]. The core component of the vibratory gyro is a micro mechanical structure which works in the resonant state and is therefore called the resonator. While the resonator rotates around the sensitive axis, the Coriolis force induces movement of the resonator’s mode shape. There are several different types of resonator available including fork, beam, finger, axisymmetric shell etc. The axisymmetric shell resonator gyroscope currently gives the best comprehensive performance and is widely applied in many fields [3,4]. The cylindrical resonator and hemispherical resonator both use a single curve surface shell. These shells have the disadvantage of vibration instability. The development tendency is towards micro and multi curved surface [5].
The bell-shaped vibratory gyro is a solid vibratory gyro, which utilizes the standing wave precession effect for sensory control of the angular velocity. The core component is a millimeter Chinese traditional bell which is named the bell-shaped resonator. The excitation and detection piezoelectric elements attach to the wall of the resonator, and control the resonator to produce the standing wave. The precession of the standing wave is proportional to the angular velocity. BVG not only has the advantages of low cost, low power consumption and longevity, but is also a simple structure with good anti-impact performance, which is well suited to the low and medium rotation angular measurement fields [6,7,8]. In [7,8], analysis, design and experiments for a BVG prototype are presented and the character of the bell-shaped resonator is studied which has isolating holes. The holes are designed to isolate the vibration from the fixation point. But the positions of the holes have an important impact on the structure, especially on the frequency split. This is why holes have been removed in this paper. In [9], the signal process method of BVG is presented, which is verified experimentally in a laboratory environment at room temperature. In [10], the disadvantages of traditional BVG signal processing are addressed by presenting a novel signal processing method using a variable structure sliding mode controller to evaluate the angular velocity. This method evidently improves the accuracy and bandwidth of the BVG. In [11,12], the effects of frequency split on error are studied and a restraint method is presented based on structure balance and circuit control.
In conclusion, the BVG is still in the prototype development phase. The mathematic model, signal processing, standing wave characteristics and frequency splitting were studied. There is an urgent requirement to improve the performance of the BVG through error compensation.
The hemispherical resonator gyro (HRG) and cylinder vibratory gyro (CVG) is currently the focus for many researchers. There has already been a lot of study on their error characteristics. V. A. Matveev wrote a book on the Solid Vibratory Gyro, which studies mainly the HRG including the mathematic model, signal processing method, error characteristics and application. This book describes a problem in the HRG development process. This research laid the foundation for a further performance study of HRG [4]. J. Pi has designed an error compensation method based on an imperfect observer to restrain the drift of HRG through the state space. The observer can compensate for errors using the imperfect model parameter [13]. This paper focuses on improving the accuracy of this method using a control method during the signal solving process, but the error compensation for HRG is not researched. X. Wang, X. Yangguang and L. Boran have built a temperature model for HRG and compensate the frequency based on the temperature [14,15,16,17]. X. Wang has studied a method to restrain the quadrature error [18]. For CVG, Innalab Inc., Waston Inc. have already designed a mature product, and have studied the error characteristics and performance [19,20]. P.W. Loveday, Y. Wu and D. Kristiansen have studied the temperature characteristics and error characteristics for CVG [21,22,23]. However, there is no error compensation method in the published literature.
This paper mainly studies the problem with the error model and compensation. A dynamic equation is firstly established, based on a study of the BVG working mechanism. This equation is used to evaluate the relationship between the angular rate output signal and the bell-shaped resonator characteristics, analyze the influence of the main error sources and set up an error model for the BVG. The error sources are classified using the error propagation properties, and a compensation method is presented based on the error model. Finally, the error model and compensation method are used to experimentally calibrate the BVG, including rough compensation, temperature and bias compensation, scale factor compensation and noise filter.

2. Working Concept of the Bell-Shaped Vibratory Gyro

The bell-shaped resonator is a core component of the BVG and looks like a millimeter-scaled Chinese traditional bell, such as the QianLong Bell or the YongLe Bell, shown in Figure 1. Eight piezoelectric elements are attached to the wall of the bell-shaped resonator, which excite the resonator and detect the signal to calculate the angular rate.
Figure 1. Structural diagram of Bell-shaped resonator.
Figure 1. Structural diagram of Bell-shaped resonator.
Sensors 15 23684 g001

2.1. Working Principle

The eight piezoelectric elements are distributed evenly around the wall of bell-shaped resonator, as shown in Figure 2. Based on the inverse piezoelectric effect, the excitation electrodes excite the bell-shaped resonator and produce a working mode within the resonator, which is named the primary mode or the excitation mode, shown in Figure 3a. For the resonator, each working frequency has two modes, which are different by 45°. The other mode is named the secondary mode or detection mode, shown in Figure 3b. The two modes are coupled by the Coriolis force. The amplitude of the second mode is proportional to the input angular velocity and produces the standing wave precession. In Figure 4, when an angular velocity is applied counterclockwise to the axis of symmetry, the standing wave angle changes. The precession angle is ϑ , which is proportional to the frame rotational angular velocity.
Figure 2. Schematic of mounted electrode.
Figure 2. Schematic of mounted electrode.
Sensors 15 23684 g002
Figure 3. Schematic of the working principle (a) Primary mode (b) Secondary mode.
Figure 3. Schematic of the working principle (a) Primary mode (b) Secondary mode.
Sensors 15 23684 g003
Figure 4. Schematic of the standing wave precession.
Figure 4. Schematic of the standing wave precession.
Sensors 15 23684 g004

2.2. Excitation and Detection of Piezoelectricity

In practical applications, the stress wave propagates on the resonator, causing a standing wave. The piezo elements sensitize the stress wave and solve the angular velocity. In order to reduce the influence of the piezoelectric elements’ quality when the resonator is rotated, the elements should be set to be near the constrained boundary. However, in order to improve the excitation efficiency and stability, the piezoelectric should be glued on a flat surface such as a cylindrical structure.
The piezoelectric elements chosen were the PZT5A, which were polarized in the thickness direction. The first and fifth elements contract and expand when the alternating current signal is applied (in Figure 5a). When the top of the elements are restrained, the force of the contraction and expansion will be transferred to the bending force (in Figure 5b) and excite the shell vibration. The piezoelectric elements and resonator are attached together by conductive adhesives. A rigid connection can be made between these elements by controlling the painting procedure. One pole of elements connected to the resonator is the GND, and the remaining elements are the input or output signals. The piezoelectric element senses the vibratory signal based on the piezoelectric effect. Using the third and seventh element feedback signals and the first and fifth excitation elements, standing wave steady control is achieved. The control loop includes an amplitude control loop and a frequency control loop. It should be given particular emphasis to the fact that the work mode of the BVG is the force-rebalance mode [7,21]. The sensitized angle of precession from the second and sixth elements is used as the controller input to drive the fourth and eight elements to restrain the precession of the standing wave. The amplitude of the restrain variable is proportional to the angular velocity and is used as the output signal of the BVG [8].
Figure 5. Schematic of piezoelectric principle.
Figure 5. Schematic of piezoelectric principle.
Sensors 15 23684 g005

3. Error Model of Bell-Shaped Vibratory Gyro

A bell-shaped resonator includes a hemispherical structure, a cylindrical structure and a hyperbolical structure. For this special multi-curved surface structure, the orthogonal curvilinear coordinate system is chosen to describe the bell-shaped resonator coordinates. The orthogonal curvilinear coordinate system uses the direction of the angle between the normal of the shell’s middle surface and the rotation axis, the rotation angle and the thickness to indicate a point of space. In [24], the author was given a detailed description of a bell-shaped resonator and deduced the curvature of a classic rotation shell. This coordinate system is used to research the characteristics of the bell-shaped resonator.

3.1. Dynamic Equation of Resonator’s Bottom Edge

The middle surface coordinates of a bell-shaped resonator on an orthogonal curvilinear coordinate system is shown in Figure 6. The coordinate-origin is defined as the center of the hemispherical structure. The direction of the z axis is the rotation axis. The radius of the hemisphere is R. The height of the cylinder is L and the hyperbola is S. The radius of the bottom is R b . The formula in Equation (1) can therefore be derived:
H e m i s p h e r i c a l :       x 2 + z 2 = R 2 ;    ( 0 z < R ) C y l i n d r i c a l :    x = R , z = t ;     ( L z < 0 ) H y p e r b o l i c a l : x 2 R 2 ( R b 2 R 2 ) ( z + L ) 2 R 2 S 2 = 1 ;    ( L S z < L )
For the three-dimensional structure of the bell-shaped resonator, a description is shown in Figure 7 using the orthogonal curvilinear coordinate system ( φ , υ , θ ) . The two principal radii of curvature are ρ 1 and ρ 2 . φ is the angle between the normal of the point and the rotation axis. θ is the angle of the circumference. υ is the direction of thickness. φ t is the angle of the top and φ b is the angle of the bottom. h is the thickness of the resonator. The domain of definition of the resonator in orthogonal curvilinear coordinates is as given in Equation (2).
Figure 6. The middle surface coordinates of a bell-shaped resonator.
Figure 6. The middle surface coordinates of a bell-shaped resonator.
Sensors 15 23684 g006
Figure 7. Schematic of bell-shaped resonator in coordinate system.
Figure 7. Schematic of bell-shaped resonator in coordinate system.
Sensors 15 23684 g007
φ t φ φ b , h 2 υ h 2 , 0 θ < 2 π
The principal radii of curvature are as follows in Equation (3).
H e m i s p h e r i c a l : ρ 1 = R , ρ 2 = R C y l i n d r i c a l : ρ 1 = , ρ 2 = R H y p e r b o l i c a l : ρ 1 = R 4 S 2 R b 2 R 2 [ ( R b 2 R 2 ) R 2 sin 2 φ R 2 S 2 cos 2 φ ] 3 2 ,                        ρ 2 = R 2 R b 2 R 2 [ ( R b 2 R 2 ) R 2 sin 2 φ R 2 S 2 cos 2 φ ] 1 2
Therefore, many relationships between the coordinate system can be established, as follows
ρ z = ρ 1 + υ ;     r z = ( ρ 2 + υ ) sin φ ;     d ρ z d z = 1 ;     d ρ z d φ = d ρ 1 d φ
The stress-strain relationship is as follows:
σ φφ = λ ε + 2 G ε ,    σ υυ = λ ε + 2 G ε υυ ,    σ θθ = λ ε + 2 G ε θθ σ φυ = 2 G ε φυ , σ φθ = 2 G ε ϕθ , σ υθ = 2 G ε υθ
where σ are the stress components and the subscript is the axis, and ε are the strain components. G is the shear modulus and G = E 2 ( 1 + γ ) . E is Young’s modulus. γ is Poisson’s ratio. ρ is the density of material. λ = 2 G γ 1 2 γ .
The displacement components are as follows:
ε φφ = 1 ρ z ( u φ φ + u υ ) ; ε υυ = u υ υ ; ε θθ = 1 r z ( u θ θ + u φ cos φ + u υ sin φ ) ε υφ = 1 2 [ u φ υ 1 ρ z ( u φ u υ φ ) ] ; ε φθ = 1 2 [ 1 r z ( u φ θ u θ cos φ ) + u θ φ ρ z ] ε υθ = 1 2 [ 1 r z ( u υ θ u θ sin φ ) + u θ υ ] ; ε = ε φφ + ε υυ + ε θθ
where u φ , u υ and u θ are the displacements in each of the three direction separately. In paper [25], the equation of motion in terms of the physical components is derived for the curvilinear ( φ , υ , θ ) coordinate system based on tensor analysis as follows:
σ φυ υ + 1 r z [ ( σ φφ σ θθ ) cos φ + σ φθ d θ + σ φθ sin φ ] + 1 ρ z ( σ φφ φ + 2 σ φυ ) 2 σ φφ ρ 1 φ ρ z 2 = f φ σ υυ υ + 1 r z [ ( σ υυ σ θθ ) sin φ + σ υθ θ + σ φυ cos φ ] + 1 ρ z ( σ φυ φ + σ υυ σ φφ ) σ φυ ρ 1 φ ρ z 2 = f υ σ υθ υ + 1 r z ( 3 σ φθ cos φ + 2 σ υθ sin φ + σ θθ θ ) + 1 ρ z ( σ υθ + σ φθ θ σ φθ r z r z φ ) σ φθ ρ 1 φ ρ z 2 = f θ
When the BVG is in working mode, the bell-shaped resonator is influenced by the frame angular velocity. For a point P ( φ , υ , θ ) , the motion expression of the vector is expressed as in Equation (8).
φ = u φ φ ^ , υ = u υ υ ^ , θ = u θ θ ^
where φ , υ and θ are the vectors of the coordinate axis and φ ^ , υ ^ and θ ^ are the unit vectors of the coordinate axis. The motion vector of point P is as follows:
= u φ φ ^ + u υ υ ^ + u θ θ ^
The angular velocity Ω along the axis of symmetry in the inertial space is:
Ω = Ω ( cos φ υ ^ sin φ φ ^ ) = Ω cos φ υ ^ Ω sin φ φ ^
According to the Coriolis Theorem, the absolute acceleration of point P in motion relative to inertial space can be expressed as:
a = a 0 + 2 Ω × ˙ + ¨ + [ Ω ˙ × ] + [ Ω × [ Ω × ] ]
where a 0 is the absolute acceleration of the bell-shaped resonator. ¨ is the acceleration of P for the resonator. ˙ is the velocity of P for the resonator. Ω ˙ is the angular acceleration of the resonator.
According to the Equation (11), the absolute acceleration of P is as follows:
a φ = u ¨ φ + Ω ˙ u θ cos φ + 2 Ω u ˙ θ cos φ Ω 2 u φ cos 2 φ Ω 2 u υ cos φ sin φ a υ = u ¨ υ + Ω ˙ u θ sin φ Ω 2 u υ + 2 Ω u ˙ θ sin φ + Ω 2 u υ cos 2 φ Ω 2 u φ sin φ cos φ a θ = u ¨ θ Ω 2 u θ Ω ˙ u φ cos φ Ω ˙ u υ sin φ 2 Ω u ˙ φ cos φ 2 Ω u ˙ υ sin φ
where, a φ , a υ and a θ are the absolute accelerations in the coordinate direction.
The natural frequency of BVG is designed to be below 10 kHz. The range is below 5000 deg/s. For these low velocity fields, the angular acceleration of the resonator and the angular squared term can be ignored. The expression of acceleration at the free edge of the resonator is then as follows:
a φ = u ¨ φ + 2 Ω u ˙ θ cos φ ;     a υ = u ¨ υ + 2 Ω u ˙ θ sin φ ;     a θ = u ¨ θ 2 Ω u ˙ υ cos φ
According to Newton’s Second Law, the inertial force of P is influenced by angular velocity as follows:
f φ = ρ h a φ = ρ h ( u ¨ φ + 2 Ω u ˙ θ cos φ ) f υ = ρ h a υ = ρ h ( u ¨ υ + 2 Ω u ˙ θ sin φ ) f θ = ρ h a θ = ρ h ( u ¨ θ 2 Ω u ˙ υ cos φ 2 Ω u ˙ υ sin φ )
Substituting Equation (14) into Equation (7) derives the motion equation of the bell-shaped resonator’s edge when the angular velocity Ω is along the rotation axis:
σ φυ υ + 1 r z [ ( σ φφ σ θθ ) cos φ + σ φθ θ + σ φθ sin φ ] + 1 ρ z ( σ φφ φ + 2 σ φυ ) 2 σ φφ ρ 1 φ ρ z 2 = ρ h ( u ¨ φ + 2 Ω u ˙ θ cos φ ) σ υυ υ + 1 r z [ ( σ υυ σ θθ ) sin φ + σ υθ θ + σ φυ cos φ ] + 1 ρ z ( σ φυ φ + σ υυ σ φφ ) σ φυ ρ 1 φ ρ z 2 = ρ h ( u ¨ υ + 2 Ω u ˙ θ sin φ ) σ υθ υ + 1 r z ( 3 σ φθ cos φ + 2 σ υθ sin φ + σ θθ θ ) + 1 ρ z ( σ υθ + σ φθ θ σ φθ r z r z φ ) σ φθ ρ 1 φ ρ z 2 = ρ h ( u ¨ θ 2 Ω u ˙ υ cos φ 2 Ω u ˙ υ sin φ )
Then, substituting Equations (5) and (6) into Equation (15) derives the model of the bell-shaped resonator. These equations are also named Navier’s displacement equations of motion. For analysis of the model, it is assumed that the bell-shaped resonator is perfect. The material parameters have a constant value and are irrelevant to the circle angle. The model is derived using the Maple program which is too complex to describe in detail here.
To solve the model, the displacement vector of an arbitrary point in the bell-shaped resonator is developed according to the second order normal vibration mode, which is not stretched [4]:
[ u φ ( φ , θ , t ) u υ ( φ , θ , t ) u θ ( φ , θ , t ) ] = [ U ( φ ) cos 2 θ V ( φ ) sin 2 θ W ( φ ) cos 2 θ ] p ( t ) + [ U ( φ ) sin 2 θ V ( φ ) cos 2 θ W ( φ ) sin 2 θ ] q ( t )
where U ( φ ) , V ( φ ) , W ( φ ) are the Rayleigh functions for the bell-shaped resonator’s second order intrinsic vibration mode on the three axes. p ( t ) and q ( t ) are the displacements of the vibratory rigid axis.
Based on the hypothesis that the shell’s middle surface is not stretched, the sheer displacement of the bend shell is equal to zero, and is as follows [4]:
ε φφ = ε θθ = ε φθ = 0
Substituting Equation (6) into Equation (17) gives the following formula:
{ u φ φ + u υ = 0 u θ θ + u φ cos φ + u υ sin φ = 0 1 r z ( u φ θ u θ cos φ ) + u θ φ ρ z = 0
Substituting Equations (16) into (18), the Rayleigh function of the resonator’s second order normal vibration mode is derived using the separation of variables method [8].
U ( φ ) = A k cos ( 5 π φ φ b ) sin 3 φ V ( φ ) = A k cos φ sin 3 φ W ( φ ) = A k 3 cos φ sin 2 φ
where A k is the amplitude function of the bell-shaped resonator. For convenient calculation, A k is defined to be constant with value 1.
Substituting Equation (5), Equation (6) and Equation (19) into Equation (15), the dynamic equation of the bell-shaped resonator’s second order normal vibration mode using Bubnov-Galyorkin method is:
{ m 0 p ¨ ( t ) 2 Ω b q ˙ ( t ) + c 0 p ( t ) + c 1 q ( t ) = 0 m 0 q ¨ ( t ) + 2 Ω b p ˙ ( t ) + c 0 q ( t ) + c 1 p ( t ) = 0
where m 0 = ρ h π W ( φ ) , b = ρ h π V ( φ ) ( cos φ + sin φ ) ,
c 0 = π { G ( W sin φ + 2 V ) ( ρ 2 + υ ) 2 sin φ + 1 ( ρ 2 + υ ) sin φ [ 2 G ( W sin φ + 2 V ) ρ 2 + υ + 2 G ( 2 V sin φ 4 W ) ( ρ 2 + υ ) sin φ + 6 G ( 1 2 W cos φ ( ρ 2 + υ ) sin φ + 1 2 W ρ 1 + υ ) cos φ + ( 2 V ρ 1 + υ + 2 sin φ V 4 W ( ρ 2 + υ ) sin φ ) λ ] + 1 ρ 1 + υ [ G ( 2 V W sin φ 4 U + W cos φ ( ρ 2 + υ ) sin φ W ρ 1 + υ ) ( d ρ 2 d φ sin φ + ( ρ 2 + υ ) cos φ ) ( ρ 2 + υ ) sin φ ], G ( W cos φ ( ρ 2 + υ ) sin φ + W ρ 1 + υ ) ( d ρ 1 d φ ) ( ρ 1 + υ ) 2 } c 1 = π [ 10 G U cos φ ( ρ 2 + υ ) sin φ + 2 λ ( U ρ 1 + υ U cos φ ( ρ 2 + υ ) sin φ ) ( ρ 2 + υ ) sin φ + 2 G U d ρ 1 d φ ( ρ 2 + υ ) ( ρ 1 + υ ) 2 sin φ + 2 G ( W cos φ ( ρ 2 + υ ) sin φ W ρ 1 + υ ) + 2 G U ( d ρ 2 d φ sin φ + ( ρ 2 + υ ) cos φ ) ( ρ 2 + υ ) 2 sin 2 φ ρ 1 + υ ] U = d U d φ , V = d V d φ , W = d W d φ .
The characteristics of the bell-shaped resonator can be derived from the precession factor and natural frequency using Equation (20). It is demonstrated that the BVG is a Coriolis vibratory gyroscope which has the advantage of vibratory gyro. The motion of the bell-shaped resonator’s edge is shown to be equivalent to a two-dimensional spring. p ( t ) is equivalent to the axis between the 0° piezoelectric electrode and the 180° electrode. q ( t ) is equivalent to the axis between the 45° piezoelectric electrode to the 225° electrode. Based on the Equation (20), the precession factor can be obtained as follows:
k = b 2 m 0
The natural frequency is as follows:
ω n = c 0 m 0

3.2. Angular Velocity Measurement

Electrodes 1 and 5 in the p(t) shafting are the driving electrodes. A sinusoidal signal at the natural frequency of the bell-shaped resonator causes the resonator to vibrate. The driving signal is generated directly using DSP with the Direct Digital Synthesis (DDS) algorithm and is applied on Electrodes 1 and 5 with the DAC. DDS also supplies the exact modulating signal for calculating the amplitude and phase. It calculates the resonator’s vibration by detection at Electrodes 3 and 7. The bell-shaped resonator can be made to generate resonance by dynamically adjusting DDS through design of the amplitude loop controller GA, and frequency loop controller GF. Electrodes 4 and 8 are detected on the q(t) axis. By analyzing the standing wave’s procession, designing the rate loop controller GR, and quadrature loop controller GQ, and dynamically adjusting the damping torque on Electrodes 2 and 6, the gyro can be made to work in force rebalance mode, leaving 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 8.
For the circuit system’s hardware application, the control loops and DDS signals are generated from DSP. The signal collection is done by DAC. The analog conditioning circuit is used for detection and driving of the piezoelectric electrodes. In the real circuit system, we use the STM32F405 as the DSP chip, DSP to supply ADC and AD5328 as the DAC chip. The core component of the analog conditioning circuit is OPA2227 9.
Figure 8. The circuit system signal flow.
Figure 8. The circuit system signal flow.
Sensors 15 23684 g008
BVG works in forced vibration. The main vibration force is applied by exciting the piezoelectric element. If the bell-shaped resonator is in a steady state as described by Equation (20), a force should be applied to the right of equation as shown in Equation (23):
{ m 0 p ¨ ( t ) 2 Ω b q ˙ ( t ) + c 0 p ( t ) + c 1 q ( t ) = f p m 0 q ¨ ( t ) + 2 Ω b p ˙ ( t ) + c 0 q ( t ) + c 1 p ( t ) = f q
where f p = A p sin ( 2 π ω p t + ϕ p ) is the force applied along axis p, A p is the amplitude of f p , ω p is the frequency of axis p, ϕ p is the phase of f p . f q = A q sin ( 2 π ω q t + ϕ q ) is the damp force applied along axis q, A q is the amplitude of f q , ω q is the frequency of axis q, ϕ q is the phase of f q .
For this vibratory gyro, the excitation force applied on axis p is the key factor to keep the resonator in a resonant state. Ideally, f p should remain unchanged. It is assumed that the natural frequency is unchanged. f q will vary based on the angular velocity Ω , and its amplitude, frequency and phase depends on the working mode of BVG. The angular velocity Ω is as shown in Equation (24):
Ω = f q 4 k p ˙ ( t ) q ¨ ( t ) + ω n 2 q ˙ ( t ) + c 1 m 0 p ( t ) 4 k p ˙ ( t ) = f p 4 k q ˙ ( t ) p ¨ ( t ) + ω n 2 p ˙ ( t ) + c 1 m 0 q ( t ) 4 k q ˙ ( t )
where the vibration of axis p keeps the resonator in steady state depending on excitation f p . The angular velocity is solved based on the displacement of axis q. In the open loop mode, the angular velocity is as shown in Equation (25). In the force rebalance mode, the angular velocity is as shown in Equation (26)
Ω = q ¨ ( t ) + ω n 2 q ˙ ( t ) + c 1 m 0 p ( t ) 4 k p ˙ ( t )
Ω = f q 4 k p ˙ ( t ) q ¨ ( t ) + ω n 2 q ˙ ( t ) + c 1 m 0 p ( t ) 4 k p ˙ ( t )
For the BVG, the force balance mode is chosen, which can improve the accuracy, restrain precession and improve bandwidth. The displacement of p ( t ) and q ( t ) is solved by the detection piezoelectric element [9].
Figure 9. The piezoelectric element.
Figure 9. The piezoelectric element.
Sensors 15 23684 g009
The piezoelectric elements are attached to the wall of the bell-shaped resonator as shown in Figure 9. The piezoelectric elements 3 and 7 measure the displacement of axis p, and the piezoelectric elements 4 and 8 measure the displacement of axis q. Based on the piezoelectric effect, the charge of piezoelectric 3, 7, 4 and 8 is
F i ( t ) = ( σ ν ν + σ φφ ) d 31 S i ,                 i = 3 , 4 , 7 , 8
where, F i ( t ) is the charge of the piezoelectric element (C), and d 31 is the piezoelectric constant of the piezoelectric element (C/N). S i is the area of the piezoelectric element in m2. Using the C-V converter circuit, the charge is converted to voltage which is collected by the ADC converter and provided to the DSP. For the digital process, the relationship is as follows:
{ p ( t ) = ς p [ F 3 ( t ) + F 7 ( t ) ] q ( t ) = ς q [ F 4 ( t ) + F 8 ( t ) ]
where, ς p is the coefficient of displacement between the synthesized voltage of the piezoelectric elements 3 and 7 and ς q is the coefficient of displacement between the synthesized voltage of piezoelectric elements 4 and 8.

3.3. Error Model

Based on the analysis results, the angular velocity of BVG can be calculated by the following expression:
Ω = A q sin ( ω q t + ϕ q ) 4 k ς p [ F ˙ 3 ( t ) + F ˙ 7 ( t ) ] ς q [ F ¨ 4 ( t ) + F ¨ 8 ( t ) ] + ω n 2 ς q [ F ˙ 4 ( t ) + F ˙ 8 ( t ) ] + c 1 m 0 ς p [ F 3 ( t ) + F 7 ( t ) ] 4 k ς p [ F ˙ 3 ( t ) + F ˙ 7 ( t ) ]
During the implementation process, the loop controller selects the damp force A q , frequency ω q and phase ϕ q . The output angular velocity is expressed as
Ω = Κ A q
where K is the coefficient of the controller, which is applied to the motion of the axes and controller algorithm.
Based on (29), the error sources of BVG include:
(1) ω p , ω q and ω n which are all different;
The difference between ω p and ω q , is known as the frequency split. Many restraining methods are given in other studies [11,12,23].
(2) The frequency of the resonator includes ω p , ω q and ω n , which are all influenced by temperature;
(3) The circuit devices are influenced by temperature;
(4) The precession factor is changed in different environments;
(5) The drift of the control loop algorithm;
(6) Noise.
Error Sources (2), (3) and (4) are difficult to compensate. These can be transferred to the gyro index which includes zero bias and a scale factor. Therefore, the error model can be described as:
Ω = S F ( Ω , T ) A q ( ξ ) N u ( T ) + v ( t )
where, S F ( Ω , T ) is the scale factor of the BVG which is determined by the angular velocity and temperature of the bell-shaped resonator. A q ( ξ ) is the output of the controller. N u ( T ) is the bias. v ( t ) is noise.

4. Compensation Principle

Based on Equation (31), the error sources can be classified into three types: bias compensation, scale factor compensation and noise filter. The error model can be described based on Equation (31) as:
Ω = S F 3 ( T ) { S F 2 ( Ω ) [ S F 1 ( A q N u 1 ) N u ( T ) ] } + v ( t )
where S F 1 is the rough scale factor. N u 1 is the rough zero null. N u ( T ) is the bias due to temperature compensation. S F 2 ( Ω ) is the scale factor due to angular velocity. S F 3 ( T ) is scale factor due to temperature. The compensation steps can be described as:
(1) Rough compensation: calculate S F 1 and N u 1 .
(2) Bias compensation: calculate N u ( T ) .
(3) Scale factor: calculate S F 2 ( Ω ) and S F 3 ( T ) .
(4) Noise: v ( t ) .

4.1. Rough Compensation

Firstly, BVG is fixed on the temperature control turntable to compensate for error, as shown in Figure 10. The output of BVG is A q and the output data is stored using an industrial computer. The update time of BVG is 100ms. The turntable remains stationary for five minutes, and then maintains a speed of +100°/s. The test curve is as shown in Figure 11.
Figure 10. Photo of the experiment.
Figure 10. Photo of the experiment.
Sensors 15 23684 g010
Figure 11. Rough compensation curve.
Figure 11. Rough compensation curve.
Sensors 15 23684 g011
As we can see in Figure 11, the rough null is −703.3858. The rough scale factor is 0.00242. The relationship between the output and angular velocity is then:
Ω C = S F 1 ( A q N u 1 ) = 0.0242 ( A q + 703.3858 )

4.2. Bias Compensation

The turntable is kept stationary and the temperature control box is maintained at −45 °C for 2 h. The temperature control box is then increased from −45 °C to +55 °C. Ω C is stored, and is as shown in Figure 12. The bias instability is 20.5°/h.
Figure 12. Ω C in temperature changes.
Figure 12. Ω C in temperature changes.
Sensors 15 23684 g012
The second-order least square compensation bias over work temperature is as expressed in Equation (34). The result is as shown in Figure 13. The standard deviation is from 0.1624°/s to 0.0619°/s.
Ω T N = Ω C ( a 1 T 2 + a 2 T + a 3 ) = Ω C ( 2.52e 05 T 2 0.0056 T + 0.1673 )
Figure 13. Temperature compensation.
Figure 13. Temperature compensation.
Sensors 15 23684 g013

4.3. Scale Factor Compensation

The scale factor error includes the angular velocity and temperature. Initially, the turntable is set to work from −360°/s to +360°/s at a constant temperature of 25 °C. The test result is shown in Figure 14. When the input angular velocity is −360°/s, the test is −361.4°/s. This shows that the scale factor changes with the input angular velocity. The linearity is 0.2% as shown in Figure 15.
Figure 14. Scale factor changes with angular velocity.
Figure 14. Scale factor changes with angular velocity.
Sensors 15 23684 g014
The second order least square compensation bias over range is as expressed in Equation (35). The linearity error is from 0.2% to 0.03% as shown in Figure 15.
Ω S F 1 = a 1 Ω T N 2 + a 2 Ω T N + a 3 = 5.89e-06 Ω T N 2 + 0.99 Ω T N -0.12
Figure 15. Scale factor compensation by angular velocity.
Figure 15. Scale factor compensation by angular velocity.
Sensors 15 23684 g015
The temperature error of the scale factor is then studied. The turntable is set to operate at 300°/s, and the temperature is increased from −45 °C to +55 °C. The result is shown in Figure 16.
Figure 16. Scale factor changes with temperature.
Figure 16. Scale factor changes with temperature.
Sensors 15 23684 g016
The second order least square compensation bias over temperature is as expressed in Equation (36). The result is as shown in Figure 17. The resulting standard deviation is from 0.1663°/s to 0.0638°/s.
Ω S F 2 = Ω S F 1 ( a 1 T 2 + a 2 T + a 3 ) = Ω S F 1 ( -1.26e-07 T 2 -1 .83e-05 2 T + 0.9979 )
Figure 17. Temperature compensation.
Figure 17. Temperature compensation.
Sensors 15 23684 g017

4.4. Noise Filter

Finally, the noise is presented using the FIR filter. The cutoff frequency is 200 Hz and a 50 order filter is used. The temperature box is set from −45 °C to +55 °C and turntable is stationary. The result is as shown in Figure 18. The signal performance is then evaluated using Allan variance as shown in Figure 19. It is shown that the bias instability is 4.67°/h (1 δ ) and the random walk is 0.6982°/h1/2.
Figure 18. Noise Filter.
Figure 18. Noise Filter.
Sensors 15 23684 g018
Figure 19. Allan Variance.
Figure 19. Allan Variance.
Sensors 15 23684 g019

5. Conclusions

This paper focuses on error modeling and compensation of the BVG. The dynamic equation is firstly established based on a study of BVG working mechanism. This equation is used to evaluate the relationship between the angular rate output signal and the bell-shaped resonator characteristics, the influence of the main error sources is evaluated and an error model of BVG is set up. The error sources are classified based on their error propagation properties, and the compensation method is presented based on the error model. Finally, the error model and compensation method are used to experimentally calibrate the BVG, which includes rough compensation, temperature and bias compensation, scale factor compensation and noise filter. The experimentally obtained bias instability is from 20.5°/h to 4.67°/h, the random walk is from 2.7821°/h1/2 to 0.6982°/h1/2 and the nonlinearity is from 0.2% to 0.03%. Based on the error compensation, it is shown that there is a good linear relationship between the sensing signal and the angular velocity, suggesting that the BVG is a good candidate for the field of low and medium rotation speed measurements.
However, the performance of BVG is lower than HRG and CVG in areas such as bias instability and randomness and BVG is a medium/low performance gyro and has a wide gap to the micro optical gyro. However, we will pay close attention to these technologies. In the future, we will study how to improve performance. In addition to this, we will study more deeply the mathematic model of the bell-shaped resonator and consider using non-contact types to design this gyroscope.

Acknowledgments

This work is supported by The National Natural Science Foundation of China (Grant No. 61261160497, 61471046). Beijing Science and Technology Project (Grant No. Z121100001612007). Beijing Municipal Commission of Education (Grant No. PXM2013_014224_000093). 40405100304, 9071223301. Supported by Beijing Key Laboratory of High Dynamic Navigation Technology.

Author Contributions

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

Conflicts of Interest

The authors declare no conflict of interest.

References

  1. Curey, R.K. Gyro and accelerometer panel: 50 years of service to the inertial community. IEEE Aerosp. Electron. Syst. Mag. 2013, 28, 23–29. [Google Scholar] [CrossRef]
  2. Armenise, M.N.; Ciminelli, C.; Dell’Olio, F.; Passaro, V.M.N. Advances in Gyroscope Technologies; Springer-Verlag: Berlin, Germany, 2011. [Google Scholar]
  3. Fan, Sh. Axisymmetric Shell Resonator Gyroscopes; National Defense Industry Press: Beijing, China, 2013. [Google Scholar]
  4. Matveev, V.A.; Basarab, M.A.; Alekin, A.V. Solid State Wave Gyro; National Defense Industry Press: Beijing, China, 2009. [Google Scholar]
  5. Liu, Y. Technology of Solid Wave Gyro and Navigation; China Aerospace Press: Beijing, China, 2010. [Google Scholar]
  6. Su, Z.; Fu, M.Y.; Li, Q.; Deng, Z.H.; Fan, J.F.; Liu, N.; Liu, H. Novel Bell-Shaped Vibrator Type Angular Rate Gyro. U.S. Patent 20140360266 A1, 11 December 2014. [Google Scholar]
  7. Su, Z.; Fu, M.; Li, Q.; Liu, N.; Liu, H. Research on bell-shaped vibratory angular rate gyro’s character of resonator. Sensors 2013, 13, 4724–4741. [Google Scholar] [CrossRef] [PubMed]
  8. Liu, N.; Su, Z.; Li, Q.; Yin, F.; Hong, L.; Fang, F. Characterization of the bell-shaped vibratory angular rate gyro. Sensors 2013, 13, 10123–10150. [Google Scholar] [PubMed]
  9. 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. [Google Scholar] [CrossRef] [PubMed]
  10. Liu, N.; Su, Z.; Liu, H.; Fan, J. Adaptive sliding mode controller for bell-shaped vibratory angular rate gyro. In Proceedings of the 2014 33rd Chinese Control Conference (CCC), Nanjing, China, 28–30 July 2014; pp. 3521–3527.
  11. Ma, X.; Su, Z.; Li, Q.; Liu, H.; Liu, N. Quadrature drift mechanism and control of bell-shaped vibratory angular rate gyro. In Proceedings of the 2014 33rd Chinese Control Conference (CCC), Nanjing, China, 28–30 July 2014; pp. 593–597.
  12. Ma, X.; Su, Z. Analysis and compensation of mass imperfection effects on 3-D sensitive structure of bell-shaped vibratory gyro. Sens. Actuators A Phys. 2015, 224, 14–23. [Google Scholar] [CrossRef]
  13. Pi, J.; Bang, H. Imperfection parameter observer and drift compensation controller design of hemispherical resonator gyros. Int. J. Aeronaut. Space Sci. 2013, 14, 379–386. [Google Scholar] [CrossRef]
  14. Wang, X.; Wu, W.; Fang, Z.; Luo, B.; Li, Y.; Jiang, Q. Temperature drift compensation for hemispherical resonator gyro based on natural frequency. Sensors 2012, 12, 6434–6446. [Google Scholar] [CrossRef] [PubMed]
  15. Xie, Y.; Yi, G.; Jia, Y.; Wang, C. Realization on identification and compensation methods for the temperature model of hemispherical resonator gyro (HRG). In Proceedings of the 2011 International Conference on Electronic and Mechanical Engineering and Information Technology (EMEIT), Harbin, China, 12–14 August 2011.
  16. Peng, H.; Fang, Z.; Lin, K.; Zhou, Q.; Jiang, C. Error analysis of hemispherical resonator gyro drift data. In Proceedings of the 2nd International Symposium on Systems and Control in Aerospace and Astronautics, Harbin, China, 10–12 December 2008.
  17. Li, B.; Wu, Y.; Wang, C. The identification and compensation of temperature model for Hemispherical resonator gyro signal. In Proceedings of the 2010 3rd International Symposium on Systems and Control in Aeronautics and Astronautics (ISSCAA), Harbin, China, 8–10 June 2010.
  18. Wang, X.; Wu, W.; Luo, B.; Fang, Z.; Li, Y.; Jiang, Q. Force to rebalance control of HRG and suppression of its errors on the basis of FPGA. Sensors 2011, 11, 11761–11773. [Google Scholar] [CrossRef] [PubMed]
  19. Chikovani, V.V.; Yatsenko, Y.A.; Barabashov, A.S.; Marusyk, P.I.; Umakhanov, E.O.; Taturin, V.N. Improved accuracy metallic resonator CVG. IEEE Aerosp. Electron. Syst. Mag. 2009, 24, 40–43. [Google Scholar] [CrossRef]
  20. Watson, W.S. Vibratory gyro skewed pick-off and driver geometry. In Proceedings of the 2010 IEEE/ION Position Location and Navigation Symposium (PLANS), Indian Wells, CA, USA, 4–6 May 2010.
  21. Loveday, P.W. Analysis and Compensation of Imperfection Effects in Piezoelectric Vibratory Gyroscopes. Ph.D. Thesis, The Virginia Polytechnic Institute and State University, Blacksburg, VA, USA, 29 January 1999. [Google Scholar]
  22. Wu, Y.; Xi, X.; Tao, Y.; Wu, X.; Wu, X. A study of the temperature characters of vibration mode axes for vibratory cylinder gyroscopes. Sensors 2011, 11, 7665–7677. [Google Scholar] [CrossRef] [PubMed]
  23. Kristiansen, D.; Egeland, O. Modeling of nonlinear vibrations for analysis and control of cylinder gyroscopes. In Proceedings of the 37th IEEE Conference on Decision and Control, Tampa, FL, USA, 16–18 December 1998.
  24. Kang, J.H. Three-Dimensional Vibration Analysis of Thick Shells of Revolution with Arbitrary Curvature and Variable Thickness; The Ohio State University: Columbus, OH, USA, 1997. [Google Scholar]
  25. Shatalov, M.Y.; Joubert, S.V.; Coetzee, C.E.; Fedotov, I.A. Free vibration of rotating hollow spheres containing acoustic media. J. Sound Vib. 2009, 322, 1038–1047. [Google Scholar] [CrossRef]

Share and Cite

MDPI and ACS Style

Su, Z.; Liu, N.; Li, Q. Error Model and Compensation of Bell-Shaped Vibratory Gyro. Sensors 2015, 15, 23684-23705. https://doi.org/10.3390/s150923684

AMA Style

Su Z, Liu N, Li Q. Error Model and Compensation of Bell-Shaped Vibratory Gyro. Sensors. 2015; 15(9):23684-23705. https://doi.org/10.3390/s150923684

Chicago/Turabian Style

Su, Zhong, Ning Liu, and Qing Li. 2015. "Error Model and Compensation of Bell-Shaped Vibratory Gyro" Sensors 15, no. 9: 23684-23705. https://doi.org/10.3390/s150923684

Article Metrics

Back to TopTop