You are on page 1of 14

International Journal of Advanced Robotic Systems

ARTICLE

An Optimal Calibration Method


for a MEMS Inertial Measurement Unit
Regular Paper

Bin Fang1,2,*, Wusheng Chou1,2 and Li Ding2


1 State Key Laboratory of Virtual Reality Technology and Systems, Beihang University, P.R. China
2 Robotics Institute of Beihang University, Beijing, China
* Corresponding author E-mail: fangbin1120@163.com

Received 14 Aug 2012; Accepted 10 Dec 2013

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.

Abstract An optimal calibration method for a micro- 1. Introduction


electro-mechanical inertial measurement unit (MIMU) is
presented in this paper. The accuracy of the MIMU is Nowadays, the progress in micro electro-mechanical
highly dependent on calibration to remove the systems (MEMSs) has enabled the development of low-cost
deterministic errors of systematic errors, which also inertial measurement units (IMUs), which are increasingly
contain random errors. The overlapping Allan variance used in biomedical applications [1], in robots’ navigation
is applied to characterize the types of random error systems [2] and in microsurgical instruments [3]. However,
terms in the measurements. The calibration model the performance of MEMS inertial sensors is degraded by
includes package misalignment error, sensor-to-sensor fabrication defects, including produced asymmetric
misalignment error and bias, and a scale factor is built. structures, the misalignment of actuation mechanisms and
The new concept of a calibration method, which deviations of the centre of mass from the geometric centre.
includes a calibration scheme and a calibration The inner factors cause output errors, which are often
algorithm, is proposed. The calibration scheme is divided into deterministic and random errors [4]. Moreover,
designed by D-optimal and the calibration algorithm is the inertial measurement unit integrated by MEMSs’
deduced by a Kalman filter. In addition, the thermal inertial sensors (MISs) may still contain IMU package
calibration is investigated, as the bias and scale factor misalignment errors and IMU sensor-to-sensor
varied with temperature. The simulations and real tests misalignment errors [4]. Therefore, it is essential to develop
verify the effectiveness of the proposed calibration an effective calibration method to reduce the errors and
method and show that it is better than the traditional increase the MIMU’s precision and stability.
method.
The method most commonly used for the calibration of
Keywords Calibration, MIMU, D-optimal, Kalman Filter, MEMS accelerometers is the six-position method [5],
Thermal which requires the inertial system to be mounted on a
levelled surface with each sensitivity axis of each sensor

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

2 Int J Adv Robot Syst, 2014, 11:14 | doi: 10.5772/57516


Based on the above analysis, the output of acceleration Assume that there are N consecutive data points, each
measured by the accelerometer can be described by the having a sample time of t 0 . Forming a group of n
following equation: consecutive data points (with n < N / 2 ), each member of
the group is a cluster. Associated with each cluster is a
V a = K a a + b a + εa (1)
time T, which is equal to nt 0 . If the instantaneous output
rate of the inertial sensor is Θ(T ) , the cluster average is
where Va is the voltage of acceleration, a is the true
defined as:
acceleration, ba is the sensor bias, K a is the scale factor
(or acceleration gain) and εa is the sensor’s noise. t k +T
1
A similar equation can be used to describe the angular
Θ k (T ) =
T  Θ(T )dt
tk
(3)

velocity measured by the gyros on the single axis:


where Θk (T ) represents the cluster average of the output
V ω = K ωω + b ω + ε ω (2)
rate for a cluster, which starts from the k th data point
and contains n data points.
where Vω is the voltage of angular velocity, ω is the
true angular velocity, bω is the sensor bias, Kω is the The definition of the subsequent cluster average is:
scale factor (or angular velocity gain) and εω is the
t k +1 + T
sensor’s noise. 1
Θnext (T ) =  Θ(T )dt (4)
T
Although the MEMS gyro’s and MEMS accelerometer’s t k +1

parameters are given in the manuals, a dynamic range


modification of the MEMS sensors exists. The errors of where t k +1 = t k + T .
the parameters as biases and scale factors are
deterministic errors, which are reduced by calibration. In
Performing the average operation for each of the two
addition, the random errors are measurement noises,
adjacent clusters can form the difference:
which should not be ignored in calibration. Therefore, the
noise needs to be characterized. For this unit, the data
were collected using a multifunction 12-b data-
ξk + 1, k = Θnext (T ) − Θk (T ) (5)
acquisition card from National Instruments, the
DAQCard-6008, which is controlled by a script based on For each cluster time T, the ensemble of ξs defined by (5)
National Instruments’ LabVIEW 2007. forms a set of random variables. The quantity of interest
is the variance of ξs over all the clusters of the same size
3. Analysis of the measurement noise
that can be formed from the entire data. Thus, the Allan
Several variance techniques have been devised for the variance of length T is defined as [21]:
stochastic modelling of the random errors. These are
basically very similar and primarily differ in that various N − 2n

[ ]
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)

Bin Fang, Wusheng Chou and Li Ding: An Optimal Calibration 3


Method for a MEMS Inertial Measurement Unit
where N is the total number of data points in the entire -2
10
run and n is the number of data points contained in the Gyro X

cluster. Gyro Y
Gyro Z

Overlapping Allan Variance(v)


Equation (7) shows that the estimation errors in the -3
10
region of a short cluster length T are small where the
number of independent clusters in these regions is large.
In contrast, the estimation errors in the region of a long
cluster length T are large where the number of
-4
10

independent clusters in these regions is small. In order to


avoid the estimation error increasing due to a lack
of samples, the overlapping Allan variance was proposed
-5
[22]. The use of overlapping samples improves the 10
-3 -2 -1 0 1 2 3
10 10 10 10 10 10 10
confidence of the resulting stability estimate. The formula Cluster times(sec)

is expressed as follows: Figure 2. Gyros overlapping Allan variance results

2 In dealing with the sensor signals over a period of time


N − 2m+1  j + m−1 
 ( )
1 
σ (T ) = 2 2
 Θi + m (T ) − Θi (T )  determined using the Allan variance analysis above, it
2m ( N − 2m + 1) j =1  i= j  will keep the bias drift minimal during the successive
time period when the calibration data are collected.
(8)
Accordingly, the white noise is only considered in the
calibration.
where m is the averaging factor.
4. Calibration method
The static data from the MIMU were collected with a
sampling rate of 1000 Hz at room temperature 25℃. By Calibration is the process of comparing the instruments
applying the overlapping Allan-variance method to output with known reference information and
the whole data set, a log–log plot of the overlapping determining the coefficients that force the output to agree
Allan standard deviation versus the cluster time is with the reference information over a range of output
shown in Figure 1 for the accelerometers data and values [23]. Moreover, many researchers [5-16] have
Figure 2 for the gyros data. As shown in these figures, developed calibration methods for the IMU. Before the
the drift characteristic of the sensors is at its worst as description of our own calibration method, a clear
σ takes the longest time interval - of about 20 s - to concept of the calibration method is introduced first of all.
converge, which means that the bias drifts of the The calibration method of the IMU should consist of two
accelerometers and gyros are much noisier. This aspects, which are a calibration scheme and a calibration
implies that the sensor bias should be averaged over a algorithm. The scheme is to design the experiments,
period of at least 20 s so that the average bias will not while the algorithm is to compute the parameters by the
change significantly over the next few 20 s intervals. experimental data. A novel calibration method is
Within 20 s, the random error can be considered as presented in this section according to this concept.
white noise.
Firstly, the complete calibration model of the MIMU is
-2 described. Next, an optimal calibration method is
10
Accelerometer X proposed by an optimal calibration scheme and an
Accelerometer Y
Accelerometer Z
optimal calibration algorithm. The scheme is the design of
a calibration experiment for the gyroscope triad and the
Overlapping Allan Variance(v)

accelerometer triad, and the calibration results are


computed by the optimal algorithm. Finally, thermal
-3
10 calibration is described.

4.1 Calibration model

The measurement model of the accelerometer or


gyroscope generally includes bias, scale factors and
-4
10
random error. Bias and scale factors are considered as the
most significant parameters, which change with different
-3 -2 -1 0 1 2 3
10 10 10 10 10 10 10
Cluster times(sec)
temperatures. It is also a very important characteristic for
Figure 1. Accelerometers overlapping Allan variance results inertial sensors (though this is dealt with by independent

4 Int J Adv Robot Syst, 2014, 11:14 | doi: 10.5772/57516


thermal calibration, as explained at the end). In this The sensor-to-sensor misalignment error or non-
section, the calibration procedure is performed at a stable orthogonality can be also considered as creating a series
temperature and the self-heating effects can be ignored, of rotation matrices that define the relationship of the
as the MIMU is calibrated after the sensors are warmed misaligned axes to those of the perfectly orthogonal triad.
up to thermal stability. Moreover, the random error can Generally, it is considered that the axes x of the frames
be considered as white Gaussian noise from the last coincide and - assuming small angles - the non-
section. orthogonality matrix can be approximated by:

In this paper, the MIMU consists of three almost  1 0 0


orthogonally mounted gyroscopes and a three-axis  
accelerometer. As to the unit, the misalignment error M o =  β yz 1 0 (13)
would be induced because of the sensors’ installation. − β zy β zx 1

The misalignment error is divided into two sources:
package misalignment error and sensor-to-sensor
Then, the total misalignment error can be written as:
misalignment error. Package misalignment error is
defined as the angle between the true axis of sensitivity
and the body axis of the package. Sensor-to-sensor
M = Mo M p
misalignment error defines the misalignment error due to  1 −θ z θy 
the non-orthogonality of the IMU’s axes.  
= β yz + θ z 1 − β yzθ z β yzθ y − θ x 
− β zy + β zxθ z − θ y β yzθ z + β zx + θ x − β zyθ y − β zxθ x + 1
The package misalignment angle can be defined as three  
angles. First, for a rotation about the z -axis by an angle  1 −θ z θy 
of θz , the matrix can be represented as follows:   (14)
≈  β yz + θ z 1 −θ x 
− β zy − θ y β zx + θ x 1 
 cos θ z sin θ z 0  
C1 = − sin θ z cos θ z 0 (9)
Consequently, the measurement of the accelerometer
 0 0 1
cluster can be expressed as:

Second, for a rotation about the y -axis by an angle θy , ac = K a M a a g + ba + v a (15)


the matrix is represented as follows:
where ag denotes the input specific force expressed in
cos θ y 0 − sin θ y  platform coordinates and v a is the measurement noise.
 
C2 =  0 1 0  (10) The scale factor matrix and bias vector of the
 sin θ y 0 cos θ y  accelerometer are defined, respectively, as:

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

θx , the matrix is represented as follows:


where kia and bia , respectively, denote the scale factor
1 0 0  and the bias of the i th accelerometer output, i = x, y, z .
C3 = 0 cos θ x − sin θ x  (11) The misalignment matrix of the accelerometer is written
as:
0 sin θ x cos θ x 
 1 −aθ z θy 
a
a 
The three angles can be considered as small angles. Then, Ma =  β yz +aθ z 1 a
− θx  (16)
the package misalignment error can be represented by the −aβ −aθ a a
β zx + θ x 1 
 zy y
following equation:
Analogously, the measurement of the gyroscope cluster
 1 −θz θy  can be written as:
 
M P = C1C 2 C 3 ≈  θ z 1 −θx  (12)
− θ y ω c = K g M g ω g + bg + v g (17)
 θx 1 

Bin Fang, Wusheng Chou and Li Ding: An Optimal Calibration 5


Method for a MEMS Inertial Measurement Unit
where ω c denotes the true platform angular velocity with  xO = P1 ⋅ I + bx + x v
respect to the inertial coordinates expressed in platform y
 O = P2 ⋅ I + by + v (20)
y

coordinates, Kg is the diagonal scale factor matrix, bg is  zO = P ⋅ I + b + z v


 3 z
the bias vector of the gyroscope cluster, and vg is the
measurement noise.
where P1 = [P11 P12 P13 ]T ,
The misalignment matrix of the gyroscope triad is written P2 = [P21 P22 P23 ]T ,
as:
P3 = [P31 P32 P33 ]T ,
 1 −gθ z g
θy 
 g 
i
O denotes the MIMU’s measurement of the
Mg =  g β yz + gθ z 1 − θx  (18)
i axis, i = x, y, z .
−gβ −gθ g
β zx + gθ x 1 
 zy y
Assume Ξ is an experimental procedure, which is used to
The task of MIMU calibration is to estimate such calibrate the parameters in equation (20). The
parameters as scale factors, misalignments, biases of the experimental procedure is composed of n tests, defined
accelerometer and the gyroscopes.Meanwhile, the as Uk ( k ∈ [1, n] ). Each test Uk corresponds to a test
experiment is implemented at 25℃ in the lab. The key position of Ξ , which is generated by the input vector
technology of the calibration can be divided according to Γk = [Ik 1] , where Ik is the vector at test point k . As a
two aspects: the calibration scheme and the calibration result, every experimental procedure can be
algorithm. We will discuss these separately in the mathematically represented as:
following sections.

4.2 Calibration scheme Ξ = {Uk (Γk ) k ∈ [1, n]} (21)

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 Ξ∈Ε

calibration parameters identifiable, but also maximizes


where Ε is the global region of positions and
their numerical accuracy. In the current context, the
Fn = [Γ 1 Γ 2  Γk ] for the design information matrix
optimal calibration positions are proposed by the D-
optimal method. of n test positions.

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

6 Int J Adv Robot Syst, 2014, 11:14 | doi: 10.5772/57516


calibration. It is noticed that the MEMS gyros in the paper 4.3.1 Kalman filter design
are low cost and cannot measure the Earth’s rotation rate.
A Kalman filter (KF) eliminates random noise and errors
Therefore, a rotation rate table is used in the calibration to
using knowledge about the state-space representation of
produce a reference signal. Meanwhile, gravity is also
the system and uncertainties in the process: the
considered as a reference signal.
measurement noise and the process noise. As such, it is
very useful as a signal filter in the case of signals with
MIMU Postures
No. Illustration random disturbances or else when signal errors can be
x y z
treated as an additional state-space variable in the
system. For linear Gaussian systems, the Kalman filter is
1 1 0 0
the optimal minimum mean square error estimator.

The model can be expressed as follows:


2 -1 0 0
Xi + 1 = ΦX i + wi
Zi + 1 = H ⋅ Xi + 1 + εi + 1 (23)
3 2 /2 2 /2 0

where X i is the state vector at time i and:


Zi + 1 - the system output (measured signal) at time i ,
4 2 /2 0 2 /2 wi - the process noise at time i ,
εi -the measurement noise at time i ,
Φ , H - matrices of the state-space representation: Φ -
the state; H - the output.
5 0 1 0
Moreover, the Kalman filter can be derived by the
following process:
6 0 -1 0
Time updating:

 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 

According to the optimal positions, a bank of Kalman


Table 2. Optimal positions for calibration
filters is deduced:
4.3 Calibration algorithm
 xi + 1= x Φx i
The calibration algorithm is the computation of the x (26)
 Zi + 1= x Hx i + 1+ xεi + 1
calibration parameters from the data, which is collected
by the calibration scheme. Because the collected data  yi + 1= y Φy i
from the MIMU contain random noise, the optimal y (27)
 Zi + 1= y Hy i + 1+ y εi + 1
estimate algorithm is generally adopted. The least
squares algorithm is the most commonly used in  zi + 1= z Φz i
estimating the calibration parameters. The algorithms z (28)
 Zi + 1= z Hz i + 1+ z εi + 1
typically lead to a biased estimate of the calibration
parameters and may give non-optimal estimates of the
where Φ = I 4×4 , x X = [bx P13 ]T ,
x
calibration coefficients. Consequently, a Kalman filter is P11 P12
designed for the calibration algorithm in what follows.

Bin Fang, Wusheng Chou and Li Ding: An Optimal Calibration 7


Method for a MEMS Inertial Measurement Unit
1 r 0 0  the MIMU when operated under different temperatures.
  There are two main approaches for thermal testing [5]: (1)
1 − r 0 0 
x
H = , r = g or ω , Allow the IMU enclosed in the thermal chamber to
1 r / 2 r/ 2 0 
  stabilize at a particular temperature corresponding to the
1 r / 2 0 r / 2 
temperature of the thermal chamber and then record the
data (this method of recording the data at specific
y
Φ = I 4×4 , y X = by [ P21 P22 ]
P23 T , temperature points is called the ‘Soak method’). (2) In the
so-called ‘thermal ramp’ method, the IMU temperature is
linearly increased or decreased for a certain period of
1 0 r 0
  time. We would use the Soak method to investigate the
1 0 −r 0
y
H = , thermal effect of the sensors.
1 r / 2 r/ 2 0
 
1 0 r/ 2 r / 2  According to equation (15) and equation (17), the model
of thermal calibration can be described:
z
Φ = I 4×4 , z X = [bz P31 P32 P33 ]T ,
ω c = K gt M g ω g + bgt + v g (31)
1 0 0 r  ac = K at M a a g + bat + va (32)
 
1 0 0 −r 
z
H = .
1 0 r/ 2 r / 2
  where K gt and K at denote the scale factors at a certain
1 r / 2 0 r / 2 
temperature,

Three simpler Kalman filters have been designed for the


and bgt and bat denote the biases at a certain temperature.
MIMU calibration. Next, the observability is analysed to
make sure that the calibration parameters are identifiable.
The misalignment parameters can be obtained by the last
According to [24], the n -state discrete linear time- section and they are not varied by the temperature, so
invariant system has the observability matrix G defined only the scale factors and biases should be estimated. The
by: calibration scheme can be designed by no. 1-6 in Table 2.

G (φ , H ) = H [ Hφ  Hφ n −1 ] (29)
Analogously, the calibration algorithms are deduced:

The system is observable if, and only if, rank (G ) = n .  t X ia+1 = Φa t X ia


We can derive the following equations from equations t a t t a t a (33)
 Z i +1 = H a X i +1 + ε i +1
(26)-(28)

rank ( x H ) = 4 , rank ( y H ) = 4 , rank ( z H ) = 4 (30)  t X iω+1 = Φω t X iω


t ω t (34)
 Z i +1 = H ω t X iω+1 + t ε iω+1
Because Φ ( i = x , y , z )are identity matrices, the rank
i

of the observability matrix is equal to the quantity of


states. We can conclude that three Kalman filters are [
where t X a = k xa k ya k za bxa bya bza ],
T

observable - in another words, the parameters can be


estimated by the measurements, which are measured by
the nine-position experiment.
t
[
X ω = kω
x k ωy kω
z bω
x bω
y bω
z ],
T

Therefore, the scale factors, biases and orthogonalization Φ a = Φω = I 6×6 ,


angles of the MIMU are estimated by the three Kalman
filters. However, the scale factors and biases are not r 0 0 1 0 0
stable in different temperatures. Therefore, thermal  
 − r 0 0 1 0 0
calibration is also important for the MIMU.
t a t ω
 0 r 0 0 1 0
H =H = .
4.4 Thermal calibration  0 − r 0 0 1 0
0 0 r 0 0 1
The purpose of thermal calibration is to reduce the errors  
 0 0 −r 0 0 1
caused by the variation of the scale factors and biases of

8 Int J Adv Robot Syst, 2014, 11:14 | doi: 10.5772/57516


It is noticed that the variances of the MIMU -4
x 10

measurements are different for different temperatures, 2 Proposed method

and so the covariance matrices of the measurement noise 1


Tradtional method

should be calculated for different temperatures. In


thermal calibration, a turntable and a thermal chamber 0

are assembled together to form a thermal-turntable unit, -1

Bias Error
as shown in Figure 3.
-2

-3

Thermal Chamber
-4

-5

1 2 3
Sensor

MIMU Figure 4. The bias errors of the two calibration methods


Rate Table
-5
x 10
12
Proposed method
Tradtional method
10
Figure 3. The thermal test setup
8
5. Calibration Results
Scale factor Error

6
5.1 Simulation and calibration results
4

In order to verify the calibration method, a Monte Carlo


simulation is first implemented. The true values of the 12 2

parameters in the calibration model are listed in Table 3. 0


It is noted that the parameters are dimensionless
parameters. -2
1 2 3
Sensor

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

Table 3. The simulation parameters 0.002

0.001

These parameters used in the simulation were chosen to 0


�x �y �z
be within the range of the expected MIMU parameters. Package misalignment angle

The sensor noise standard deviation is:


Figure 6. The package misalignment angle errors of the two
calibration methods
σ = [0.001 0.001 0.001] (35)
The parameters’ errors are smaller under the proposed
Both the traditional method and the proposed approach method. Meanwhile, we find that parameters estimated
were performed in the simulation. It is noted that the by the traditional method will deviate significantly when
traditional method is the method of least squares [5]. The the noise standard deviation is increased. However, the
results are shown in Figures 4-7. proposed method is still effective.

Bin Fang, Wusheng Chou and Li Ding: An Optimal Calibration 9


Method for a MEMS Inertial Measurement Unit
0.06 1.8
Proposed method �x
Tradtional method 1.6 �y

Accelerometer Package misalignment angle� � �


0.05 �z
1.4

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

The simulation results have shown the performance of


the filter and the accuracy of the proposed method. Next, 1.6
the MIMU is calibrated in the lab, using a cube and a rate � yz

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

measurements from the MIMU. The collected data were 1


later read into the MATLAB program for processing. The
calibration results are shown as follows. Figures 8-11 0.8

show the parameters of the three-axis accelerometers 0.6


while the gyros’ are shown in Figures 12-15.
0.4

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 �

Figure 11. Non-orthogonality angles of the accelerometers

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 �

Figure 8. Bias of the accelerometers 2.5

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

0.0802 Figure 12. Bias of the gyros


0.08
The estimated results are listed in Table 4. It indicates that
0.0798
the estimating procedure is convergent and it takes less
0.0796
0 500 1000 1500 2000 2500 3000 than two seconds to complete. The parameters converge
Time(ms)
quickly to the stable values.
Figure 9. Scale factor of the accelerometers

10 Int J Adv Robot Syst, 2014, 11:14 | doi: 10.5772/57516


x 10
-3
Acc. X Acc. Y Acc. Z Gyro X Gyro Y Gyro Z
5.3
Gyro X (m/s2) (。/s)
5.25 Bias
Gyro Y
Gyro Z
1.79 1.66 1.74 2.51 2.52 2.48
5.2
Scale (mv/m/s2 ) (mv/。/s)
5.15 factor 80.80 80.14 80.84 5.07 5.09 5.17
Gyro Scale factor� v/ � /s �

5.1 θx (。) 0.06 -0.18


5.05
θy (。) 0.20 0.05
θz (。) 0.19 0.15
5
β yz (。) 0.01 1.32
4.95 β zy (。) -0.02 1.05
4.9 β zx (。) -0.01 1.15
4.85 Table 4. The calibration results of the MIMU
4.8
0 500 1000 1500 2000 2500 3000
Time� ms � We calculate the variances of the MIMU measurements at
different temperatures. The results are listed in Table 5,
Figure 13. Scale factor of the gyros
and they are different for the different temperatures. The
scale factors and biases for the MIMU at different
2 temperatures are shown in Figures 16-19. We can see that
�x
1.5 �y the biases and scale factors of the MIMU vary
�z
significantly with temperature. Hence, it is necessary to
Gyro Package misalignment angle� � �

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� � �

Table 5. The measurement variance for different temperatures


2

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

Figure 15. Non-orthogonality angles of the gyros 0.0795

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

to 50℃. A total of nine different temperatures are


considered in this experiment. For each temperature, the Figure 16. Variation of the accelerometer scale factor with
temperature
MIMU is allowed to stabilize before recording data.

Bin Fang, Wusheng Chou and Li Ding: An Optimal Calibration 11


Method for a MEMS Inertial Measurement Unit
1.85 measurements of the static IMU are compared by two
calibration methods. The results are shown in Figures 20-
Accelerometer X
Accelerometer Y

1.8
Accelerometer Z 21. By comparison with the traditional method, the
proposed method can improve the measurement
Accelerometer Bias � m/s 2�

precision by an order of magnitude.


1.75

-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

Figure 17. Variation of the accelerometer biases with temperature


2

-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

Figure 20. The measured accelerations with zero-inputs


5.05

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.

12 Int J Adv Robot Syst, 2014, 11:14 | doi: 10.5772/57516


We get the misalignment angles in the optimal calibration [2] Metni, N., Pflimlin, J.M., Hamel, T., Soueres, P.,
at a stable temperature, and then estimate the biases and Attitude and gyro bias estimation for a VTOL UAV.
scale factors of the MIMU at different temperatures by Control Engineering Practice, 2006, 14, 1511-1520.
thermal calibration. The experiments have shown that the [3] Ang,W.T., Khosla, P.K., Riviere, C.N., Kalman
random errors’ variances of the measurements are filtering for real-time orientation tracking of
different. It is useful for the estimation of the biases and handheld microsurgical instrument. Proc. of 2004
scale factors by the Kalman filter. As observed in Figure IEEE/RSJ Int. Conf. on Intelligent Robots and
17 and Figure 19, there is an almost linear relationship Systems, Sep. 28-Oct. 2, 2004, Sendai, Japan.
between the biases and temperatures. Hence, a linear [4] Mamoun F.A.-H., On the development of an inertial
interpolation formula can be deduced for calibration in navigation error-budget system. Journal of the
the temperature range. As observed from Figure 16 and Franklin Institute, 2009, 2(8), 1-21.
Figure 20, the scale factors have an ambiguous [5] Aggarwal, P., Syed, Z., Niu, X., El-Sheimy, N.A.,
relationship with temperature, but the interpolation Standard testing and calibration procedure for low
polynomial can be obtained. The temperature drift errors cost MEMS inertial sensors and units. The Journal of
can be reduced by thermal calibration. Navigation, 2008, 61, 323-336.
[6] Syed, Z.F., Aggarwal, P., Goodall, C., Niu, X., El-
6. Conclusion Sheimy, N., A new multi-position calibration method
for MEMS inertial navigation systems. Meas. Sci.
The calibration of MIMU is an important phase in Technol., 2007, 18, 1897-1907.
improving performance. This paper has presented an [7] Ang, W.T., Khosla, P.K., Riviere, C. N., Nonlinear
optimal calibration method for the MIMU, together with regression model of a low-g MEMS accelerometer.
deduction, simulation and experimental results. We IEEE Sensors Journal, Jan. 2007, 7(1), 81-88.
analyse the random errors by overlapping Allan variance, [8] Renk, E., Rizzo, M., Collins, W., Lee, F., Bernstein, D.,
and the white noise is taken account of by the calibration. Calibrating a tri-axial accelerometer-magnetometer.
The general calibration model includes such calibration Control Systems Magazine, IEEE 25, 2005, 86-95.
parameters as scale factors, biases, package misalignment [9] Bonnet, S., Bassompierre, C., Godin, C., Lesecq, S.,
error angles and sensor-to-sensor misalignment angles. A Barraud, A., Calibration methods for inertial and
new concept for a calibration method is proposed. magnetic sensors. Sensors and Actuators A, 2009,
Moreover, the new calibration scheme is presented by the 156, 302-311.
D-optimal method, the new calibration algorithms are [10] Kim, A., Golnaraghi, M.F., Initial calibration of an
designed with Kalman filters, which are used to obtain inertial measurement unit using an optical position
optimal estimates of the calibration parameters. tracking system. IEEE Position Location and
Simulations have verified their feasibility and Navigation Symposium 2004, Apr. 2004, 96-101.
effectiveness. Thermal calibration has been accomplished [11] Lai, Y.C., Jan S.S., Hsiao F.B., Development of a low-cost
because the biases of accelerometers and gyroscopes vary attitude and heading reference system using a three-
significantly with temperature. The experiment results axis rotating platform. Sensors 2010, 10, 2472-2491.
have demonstrated that the new approach outperforms [12] Fong, W.T., Ong, S.K., Nee A.Y.C., Methods for in-
traditional methods. In future, the calibrated MIMU will field user calibration of an inertial measurement unit
be used for remotely-operated vehicle navigation for a without external equipment. Measurement Science
nuclear power plant. and technology, 2008, 19, 1-11.
[13] Jurman, D., Jankovec, M., Kamnik, R., Topic, M.,
7. Acknowledgments Calibration and data fusion solution for the
miniature attitude and heading reference system.
This work has been supported by National Key Basic Sensors and Actuators A: Physical 138, 2007, 411-420.
Research Program of China under Grant No.2013CB0355 [14] Hwangbo, M., Kanade, T., Factorization-based
03, China Program on Magnetic Confinement Fusion calibration Method for MEMS inertial measurement
under grants number 2012GB102006 and the National unit. 2008 IEEE International Conference on Robotics
High-tech R&D Programme of China (863 Programme: and Automation Pasadena, CA, USA, May 19-23,
2011AA040201). 2008, 1306-1311.
[15] Zhang, H.L., Wu, Y.X., Wu, W.Q., Wu, M.P., Hu, X.P.,
8. References Improved multi-position calibration for inertial
measurement units. Meas. Sci. Technol., 2010, 21, 1-12.
[1] Fourati, H., Manamanni, N., Afilal, L., Handrich, Y., [16] Panahandeh, G., Skog, I., Jansson, M., Calibration of
Posture and body acceleration tracking by inertial the accelerometer triad of an inertial measurement
and magnetic sensing: application in behavioral unit, maximum likelihood estimation and Cram´er-
analysis of free-ranging animals. Biomedical Signal Rao Bound. 2010 International conference on IPIN,
Processing and Control, 2011, 6, 94-104. 15-17 Sep. 2010, Zurich, Switzerland, 1-6.

Bin Fang, Wusheng Chou and Li Ding: An Optimal Calibration 13


Method for a MEMS Inertial Measurement Unit
[17] Begot, S., Voisin, E., Hiebel, P., D-optimal [22] Howe, D.A., Allan, D.W., Barnes, J.A., Properties of
experimental design applied to a linear magnet signal sources and measurement methods.
ostatic inverse problem. IEEE Transactions on Frequency Control Symposium 35, 1981, 464-469.
Magnetics, 2002, 38(2), 1065-1068. [23] Chatfield, A., Fundamentals of high accuracy inertial
[18] Fu, L., Zhu, Y.Q., Wang, L.L., Wang, X.L., A D- navigation. American Institute of Aeronautics and
optimal multi-position calibration method for Astronautics, 1997.
dynamically tuned gyroscopes. Chinese Journal of [24] Goshen-Meskin, D., Bar-Itzhack, I.Y., Observability
Aeronautics, 2011, 24, 210-218. analysis of piece-wise constant systems. IEEE
[19] ADXRS300, ±300◦/s Single Chip Yaw Rate Gyro with Transactions on Aerospace and Electronic. I. Theory.
Signal Conditioning, Analog Devices. Oct 1992, 28(4), 1056-1067.
[20] MMA7260QT, ±1.5g Three Axis Low-g Micromachined
Accelerometer, Freescale Semiconductor.
[21] El-Sheimy, N., Hou, H., Niu, X.J., Analysis and
modeling of inertial sensors using Allan variance.
IEEE Transactions on Instrumentation and
Measurement, 2008, 57(1), 140-149.

14 Int J Adv Robot Syst, 2014, 11:14 | doi: 10.5772/57516

You might also like