Professional Documents
Culture Documents
ARTICLE
DOI: 10.5772/57516
© 2014 The Author(s). Licensee InTech. This is an open access article distributed under the terms of the Creative
Commons Attribution License (http://creativecommons.org/licenses/by/3.0), which permits unrestricted use,
distribution, and reproduction in any medium, provided the original work is properly cited.
Int JWusheng
Bin Fang, Adv Robot Syst,and
Chou 2014, 11:14An| doi:
Li Ding: 10.5772/57516
Optimal Calibration 1
Method for a MEMS Inertial Measurement Unit
pointing, alternately, up and down. This calibration filter. The calibration parameters, like scale factors,
method can be used to determine the bias and scale misalignments and biases, are estimated. Afterwards,
factors of the sensors, but cannot estimate the axes thermal calibration is implemented to determine the scale
misalignments or non-orthogonalities. The multi-position factors and biases in different temperatures. In the end,
calibration method is proposed to detect more errors [6]. the results of the simulations and experiments verify the
These methods depend on the earth’s gravity as a stable effectiveness of the proposed method, and the
physical calibration standard. Furthermore, some special performance of the MIMU is improved after the
apparatus, such as motion sensing equipment [7] and calibration.
robotic arms [8-9], are used for calibration. For the
calibration of low-cost MEMS gyroscopes, the Earth’s The paper is organized as follows. Section 2 presents the
rotation rate is smaller than its resolution. Therefore, the hardware of the MIMU and introduces the inertial sensor
traditional calibration method is dependent on a model. Section 3 describes the character of the sensors’
mechanical platform, rotating the IMU into different, pre- measurement noise, and the overlapping Allan variance
defined, precisely-controlled orientations and angular is applied. Section 4 gives the MIMU model, where the
rates. Such a method was primarily designed for in-lab scale factors, package misalignments, sensor-to-sensor
tests, which often require the use of expensive equipment misalignments and biases of the accelerometer and
[5]. Therefore, some calibration methods that do not gyroscope triads are considered as the calibration
require the mechanical platform have been proposed. In parameters. Then, the optimal calibration algorithm for
[10], an optical tracking system is used. In [11], an the gyroscope triad and the accelerometer triad is
affordable three-axis rotating platform is designed for the proposed, followed by the optimal calibration scheme
calibration. Meanwhile, schemes for in-field user designed by the D-optimal method. The thermal
calibration without external equipment are proposed. calibration of the MIMU is presented at the end of the
Fong et al. [12] calibrated gyroscopes by comparing the section. Section 5 reports the calibration results of MIMU
outputs of the accelerometer and the IMU orientation through both simulations and real tests. It shows that the
integration algorithm after arbitrary motions, which improved multi-position approach outperforms the
requires an initial rough estimate of the gyroscope’s traditional calibration method. Conclusions are drawn in
parameters. Jurman [13] and Hwangbo [14] proposed a kind section 6.
of shape-from-motion calibration method with
magnitude constraint of motion. Furthermore, the 2. Hardware description
calculation algorithm is another important issue. The
A MIMU has been constructed by using MEMS gyros and
calibration parameters are computed by the algorithm.
a MEMS accelerometer. A MMA7260 accelerometer
The least squares method is the algorithm most
measures the triple-axis acceleration; three single-axis
commonly used in scalar calibration to estimate the
ADXRS300 gyros measure the angular rate in yaw, roll
calibration parameters [6, 11-14]. H.L Zhang et al. [15]
and pitch. Finally, the printed circuit boards (PCBs) of the
implemented an optimal calibration scheme by
x, y gyros are kept orthogonal by a slot.
maximizing the sensitivity of the measurement norms
with respect to the calibration parameters. The algorithms
typically lead to a biased estimate of the calibration The dynamic range of the ADXRS300 gyro is ±300◦/s [19],
parameters and may give non-optimal estimates of the and full range-scale of the MMA7260QT accelerometer is
calibration coefficients. To avoid this, Panahandeh et al. ±1.5 g [20]. The outputs from the sensors are analogue
[16] solved the identification problem by using the voltages that are proportional to the inputs as the rotation
maximum likelihood estimation (MLE) framework, but rate or acceleration. At zero input, the nominal output of
only simulation results are presented. In fact, the biases the sensor is bias; positive rotation (clockwise) or
and scale factors vary with temperature. The thermal acceleration increases the voltage from the nominal null
calibration is also an indispensable process for MIMU. offset value, whereas negative rotation (anticlockwise) or
However, the literature seldom completes this type of deceleration decreases the voltage output. The null offset
calibration. value must be subtracted from the raw sensor output
measurements. The specifications of the sensors are
In this paper, an optimal calibration method for a MIMU shown in Table 1.
is presented. Firstly, the measurement noise of the
Nominal
sensors is analysed to provide the information for the Nominal bias
Scale Factor
calibration. Next, the concept of the calibration method is
ADXRS300 gyro 2.5 V 5 mv/°/s
introduced, which consists of a calibration scheme and a
MMA7260QT
calibration algorithm. The optimal calibration scheme is 1.65 V 800 mV/g
accelerometer
designed by the D-optimal method [17-18]. Meanwhile, the
optimal calibration algorithm is deduced by a Kalman Table 1. The specifications of the sensors
[ ]
1 2
signal processing - by way of weighting functions, σ 2 (T ) = Θnext (T ) − Θk (T ) (6)
window functions, etc. - are incorporated into the
2(N − 2n ) k =1
analysis algorithms in order to achieve a desired result
for improving the model characterizations. The simplest Obviously, for any finite number of data points (N), a
is the Allan variance. finite number of clusters of a fixed length (T) can be
formed. Hence, equation (6) represents an estimation of
The Allan variance is a method of representing the root the quantity σ 2 (T ) whose quality of estimate depends on
mean square (RMS) random drift error as a function of the number of independent clusters of a fixed length that
averaging time. It is simple to compute and relatively can be formed. It is normally plotted as the square root of
simple to interpret and understand. The Allan variance the Allan variance σ (T ) versus T on a log–log plot.
method can be used to determine the characteristics of the
underlying random processes that give rise to the data
In addition, the percentage error is equal to:
noise. This technique can be used to characterize various
types of error terms in the inertial-sensor data by
1
performing certain operations on the entire length of σ (δ ) = (7)
data. 2(N n − 1)
cluster. Gyro Y
Gyro Z
And finally, for a rotation about the x -axis by an angle of K a = diag (k xa , k ya , k za ) , ba = bxa [ b ya bza ]
T
The calibration scheme is the experiment design for the with associated outputs iO .
MIMU. Generally, a multi-position calibration scheme is
used for the IMU’s calibration. The general principle of It is shown that a D-optimal design can be achieved with
the method is to design enough positions to estimate the p ≤ n ≤ p ( p + 1) 2 , where p is the number of parameters
calibration parameters. At least 12 different equations for
to be estimated. From equation (21), one can see that there
determining (that is, at least 12 positions for the MIMU)
are four unknown parameters for each output axis, so the
are required in calibration, as there are 12 unknown
optimal number of measurement positions must exist in
parameters in both the accelerometer triad and the
[5,13].
gyroscope triad. In order to avoid computational
singularity in estimation, more positions are desired to
Then, the optimal function can be described as follows:
get numerically reliable results in reality. Afterwards, the
question as to how the positions are designed in
Find: Ξ∗ = [Γ 1 Γ 2 Γk ]∈ Ε
calibration arises. The current literature has seldom
discussed in detail how the positions are optimized - in
With: Ξ = arg max{Dn (Ξ ) = det (Fn T Fn n )} (22)
other words, the scheme not only makes all the Ξ∈Ε
According to equations (15)-(17), the following equation In addition, the procedure of D-optimal design is
can be deduced: described as follows:
1) Select n test positions from global candidate
O = PI + b + v (19) positions and calculate the object function Dni
2) Select a maximum Dni and let Dn = max Dni
3) n ≤ 12 ,return to step 1)
where P = K a M a or K g M g , I = a g or ω g denotes the 4) Optimal experiment positions Ξ ∗
input vector of MIMU, O = ac or ωc denotes the vector
of the MIMU’s measurement, v = va or v g , b = ba or bg . Four optimal positions for each iO are acquired; therefore,
totally, 12 optimal positions can be attained for
calibration. Then, there are the duplicate positions. After
By rearranging equation (19), we can attain the following
removing the duplicate positions, the nine optimal
equations:
positions (which are listed in Table 2) are used for
Pi | i − 1 = Φi − 1 Pi − 1Φi − 1T
(24)
7 0 2 /2 2 /2 Xˆ i | i − 1 = Xˆ i − 1
Measurement updating:
8 0 0 1
(T
Ki = Pi | i − 1Hi HiPi | i − 1Hi + Ri
T −1
)
ˆ
( )
Xi = Xˆ i | i − 1 + Ki Zi − HiXˆ i | i − 1 (25)
Pi = (I − KiHi )Pi | i − 1
9 0 0 -1
G (φ , H ) = H [ Hφ Hφ n −1 ] (29)
Analogously, the calibration algorithms are deduced:
Bias Error
as shown in Figure 3.
-2
-3
Thermal Chamber
-4
-5
1 2 3
Sensor
6
5.1 Simulation and calibration results
4
Sensor 1 Sensor 2 Sensor 3 Figure 5. The scale factors error of the two calibration methods
Bias 2.0 2.5 2.9
Scale factor 0.01 0.05 0.09 0.01
Proposed method
θx 0.01 0.009 Tradtional method
θy 0.05 0.008
θz 0.1
0.007
0.006
β yz 0.5
Error
0.005
β zy 0.5
0.004
β zx 0.8 0.003
0.001
0.04
1.2
1
Error
0.03
0.8
0.02
0.6
0.01 0.4
0.2
0
� yz � zy � zx
0
non-orthogonality angle 0 500 1000 1500 2000 2500 3000
Time� ms �
Figure 7. The orthogonalization angle errors of the two
calibration methods Figure 10. Package misalignment angles of the accelerometers
table. The outputs were sampled at a rate of 1000 Hz and Accelerometer non-orthogonality angle� � �
1.4 � zy
� zx
the LabVIEW program stored the digitalized analogue 1.2
1.8 0.2
Accelerometer X
Accelerometer Y 0
Accelerometer Z
-0.2
0 500 1000 1500 2000 2500 3000
Accelerometer Bias � m/s 2�
1.75 Time� ms �
1.7
2.53
Gyro X
Gyro Y
2.52
Gyro Z
1.65
0 500 1000 1500 2000 2500 3000 2.51
Time� ms �
Gyro-Bias � � /s �
0.0814 2.49
Accelerometer X
0.0812 Accelerometer Y
2.48
Accelerometer Z
0.081
Accelerometer Scale factor(v/m/s2)
2.47
0.0808
0.0806 2.46
0 500 1000 1500 2000 2500 3000
Time� ms �
0.0804
1
get the thermal calibration model for low-cost MEMS
0.5 sensors to compensate for these biases and scale factor
drift with temperature.
0
-0.5
Variance(10-5v2)
-1 Temperature(℃) Gyro Gyro Gyro Acc. Acc. Acc.
X Y Z X Y Z
-1.5
0 2.14 2.46 1.77 5.92 4.86 5.31
-2
0 500 1000 1500 2000 2500 3000
10 1.42 2.45 1.91 6.75 6.83 5.93
Time� ms � 15 1.73 1.27 1.65 6.02 6.57 6.78
20 2.37 1.69 2.31 5.02 6.60 6.51
Figure 14. Package misalignment angles of the gyros
25 1.27 0.92 1.92 3.57 4.23 2.47
30 0.98 0.95 1.24 4.86 6.47 5.26
3.5 35 2.75 1.48 2.44 5.44 5.27 6.50
� yz
3 � zy 40 2.58 0.69 1.25 5.05 6.85 7.24
2.5
� zx
50 1.16 2.29 2.42 6.57 7.17 7.75
Gyro non-orthogonality angle� � �
1.5
0.082
1 Accelerometer X
Accelerometer Y
0.5 0.0815
Accelerometer Z
Accelerometer Scale Factor� v/m/s2�
0
0.081
-0.5
0.0805
-1
0 500 1000 1500 2000 2500 3000
Time� ms � 0.08
0.079
5.2 Thermal calibration results
0.0785
The temperature of the thermal chamber varies from 0℃ 0 5 10 15 20 25 30
Temperature� deg C�
35 40 45 50
1.8
Accelerometer Z 21. By comparison with the traditional method, the
proposed method can improve the measurement
Accelerometer Bias � m/s 2�
-3
x 10
10
1.7
X-Proposed method
Y-Proposed method
8 Z-Proposed method
1.65 X-Traditional method
Y-Traditional method
6 Z-Traditional method
Acceleration(m/s 2)
1.6
0 5 10 15 20 25 30 35 40 45 50
Temperature� deg C� 4
-3
x 10
5.2
0
Gyro X
Gyro Y
5.15 Gyro Z
-2
0 10 20 30 40 50
Temperature� deg C�
Gyro Scale Factor� v/� /s �
5.1
5
X-Proposed method
0.15
Y-Proposed method
Z-Proposed method
4.95
0.1 X-Traditional method
Y-Traditional method
Z-Traditional method
Angular velocity(� /s)
4.9 0.05
0 5 10 15 20 25 30 35 40 45 50
Temperature� deg C�
0
Figure 18. Variation of the gyroscope scale factor with temperature
-0.05
2.53
-0.1
Gyro X
Gyro Y
2.52
Gyro Z -0.15
2.51 0 10 20 30 40 50
Temperature� deg C�
Gyro Bias � � /s �
2.5
Figure 21. The measured angular velocities with zero-inputs
2.49
5.3 Discussion
2.48
Light-weight and low-cost MIMUs are widely used.
2.47 However, these units need calibration for an accurate
measurement solution. The computed biases, scale factors,
2.46
0 5 10 15 20 25 30 35 40 45 50 package misalignment angles and sensor-to-sensor
Temperature� deg C�
misalignment angles are estimated in a stable
Figure 19. Variation of the gyroscope biases with temperature temperature through the optimal calibration method. By
observing the estimated parameters of the MIMU, we can
To evaluate the performance of the proposed calibration find out the differences between sets of sensors, even
method, we compare it with the six-position method used though they belong to the same type. In fact, the
in [5] which is the most commonly used. This requires the parameters’ values are not identical to the specifications’
IMU to be mounted on a levelled table with each sensitive values. Meanwhile, it is evident that the accelerometer
axis pointing alternately up and down. For a triad of triad contains smaller orthogonalization errors than the
orthogonal sensors, this results in a total of six positions. gyros, since the accelerometer triad consists of one three-
The thermal calibration is implemented by the traditional axis sensor while the gyroscope triad has three single-axis
method for the same temperature. Next, the calibrated sensors, which are not easy to install orthogonally.