One of the key factors of INS
accuracy is calibration of an accelerometer module which is the essential part
of navigation system. Calibration is an estimation process performed to
determine parameters of the error model that describes how sensor errors form.
One of the traditional approaches to calibrate an accelerometer module is a
fixed base calibration, done by measuring a g-vector, perceived in module frame
of reference in different angular orientations of a turn table. The discrepancy
between expected and actual measurements can be used to estimate parameters of
error model that caused these errors [1, 2, 3, 6]. This problem can be
described as an inconsistent system of linear equations and can be solved via
least-square methods or Kalman filtering. A set of orientation angles chosen
for calibration determines a conditioning of a problem and therefore robustness
of the estimation result to unaccounted disturbances in measurements.
Typically, the main source of such disturbances are errors in angular
positioning of turn table [1, 4]. In practice orientation angles are usually
chosen to guarantee full observability of estimated parameters without taking
into consideration a conditioning of an obtained system [3, 5, 6, 7]. By
choosing optimal orientation set for calibrated module it is possible to get a
well conditioned system of equation and therefore increase calibration
accuracy. The paper introduces an efficiency function of particular measurement
which is convenient to use for determining proper module alignments by finding
its extreme points via optimization algorithm. In approach shown in [8] some of
angular orientations are found numerically to maximize determinant of
observation matrix in case of strictly orthogonal sensor alignment for vector
calibration method, but no validation with virtual modeling or hardware are
shown. This paper proposes a method to form a set of optimized orientation
angles for best system conditioning on every calibration measurement with no
necessity in orthogonal sensor alignment inside a module. In order to find
extreme points of the efficiency function with numerical optimization algorithm
this function must be visualized.
The paper contains an approach to
form such efficiency function for each of the calibration measurements. The
parameters of error model are then estimated to fit the discrepancy between
measurements. The main feature of scalar calibration is a linear system that
establish linear relation between vector of model parameter deviation values and
discrepancy between absolute expected value of perceived acceleration and its
measured absolute value [7]. Presented method allows to chose various equally
optimal orientations for each measurement due to periodic property of an
efficiency function which may be useful in case of asymmetry in scaling
coefficients.
The model includes 3 accelerometers
mounted on gyro-stabilized platform so that their axes
and
are orthogonal to each other. Nominal alignment
of second accelerometer axis
is co-directional to vertical OY axis in
bound frame of reference. Nominal alignment of first and third accelerometer
axes
,
lie in OXZ plane in bound frame of
reference.
The model which is also described in
[9] embodies a set of most important [1-3, 5-10] factors and parameters that
define how errors in sensor measurements form:
1. Errors of accelerometer
misalignment in sensor module frame of reference (bound frame). These are
angles
,
and
,
for accelerometers 1 (OX) and 3 (OZ)
respectively.
,
are angles between accelerometer 1 and 3
axes and OXZ plane.
,
are angles between projections of
and
on OXZ plane and OX axis (Fig. 1). For accelerometer
2, which corresponds to OY axis, these are angles
and
(Fig. 2) – the angles between vertical OY
axis and
projection on OXY and OYZ respectively;
Fig.1. Angular parameters for accelerometer 1 and 3 (X and Z)
alignment.
Fig. 2. Angular parameters for accelerometer
2 (Y) alignment.
2.
- accelerometer 1, 2 and 3 scale coefficients;
3.
- accelerometer 1, 2 and 3 biases;
Vectors
,
,
with those parameters as elements are related to accelerometer
output by functions:
.
|
(1)
|
Here:
-
-
i-th
accelerometer output;
-
-
i-th
accelerometer sensitivity vector determined by sensor alignment and scale
coefficient deviation;
-
- gravity acceleration
vector at particular location, perceived in bound reference frame and time
dependent due to rotation of calibrated module and Earth rotation.
Relation between accelerometer alignment parameters and
vector
(i = 1, 2, 3) defined by those expressions:
Model implies that measurement errors are formed due to
deviation of the parameters from their nominal value.
Scalar calibration method is shown in details in [3, 6,
7, 11] and utilizes scalar function
which is a sum of squared output values from each of 3 sensors
taken at one moment of time. Vector
is composed of vectors
,
and
and holds error model parameters for all accelerometers. Gravity
acceleration vector
is a measured reference value in calibration. For defined relative
orientation of sensitivity axes and nominal values of error model parameters
one can obtain expected scalar function value
and this value will remain constant for every angular orientation
of whole module. It is assumed that discrepancy between expected and actual
measured values of
within small limits is a contributed result of every parameter
deviation from their defined nominal value. Assuming these deviations to be
small enough, difference
can be approximated by linear function:
.
|
(3)
|
where
is a vector of nominal values of error parameters.
With varied angular orientation of accelerometer module
equation (3) forms linear equation system where
is dependent of module angular orientation. Note that in scalar
calibration method some parameters in
are not observable. The actual vector of parameters available for
estimation:
.
|
(4)
|
Similar to vector calibration, vector of parameter
deviation
in scalar case can be estimated using least square method or Kalman
filtering.
Row vectors of partial derivatives
for every moment where measurement is taken form matrix
:
.
|
(5)
|
Discrepancies
for every moment of time form vector
.
Thus calibration problem appears as estimating a solution for
inconsistent or over-determined system of linear equations.
.
|
(6)
|
In case of least square method applied the solution is
presented as:
.
|
(7)
|
The entire effect of estimated deviation of error
parameters of the model is contained in vector
.
However, aside from estimated factors,
is affected by some unaccounted conditions, that form sensor output
as well (errors in module angular orientation relative to Earth, thermal
distortion). Besides, variations of
will have an effect on accuracy of vector
estimation, and that influence can be evaluated by condition number
of quadratic matrix
.
Calibration matrix
and, therefore, matrix
form depending on choices of module angular orientations while
taking measurements during calibration process. Orientation sets used earlier
yield ill-condition matrices (Table. 1).
The accuracy of estimation is quite high
for computer imitation. In this case the error model considers only
“clean”
with error factors without any measurement noise and with precise
module angular orientations. However, with mixing a noise into
accuracy drops to unsuitable level.
Table 1. Earlier used angular orientation set for scalar
calibration.
¹
|
Rotation OX,o
|
Rotation OY,o
|
Rotation OZ,o
|
1
|
0
|
0
|
0
|
2
|
40
|
10
|
40
|
3
|
80
|
20
|
80
|
4
|
120
|
30
|
120
|
5
|
160
|
40
|
160
|
6
|
200
|
50
|
200
|
7
|
240
|
60
|
240
|
8
|
280
|
70
|
280
|
9
|
320
|
80
|
320
|
|
3.3·104
|
Even in fixed-base calibration, mounted frame of
reference has its errors in angular orientation relatively to Earth. These
errors being unaccounted will have their effect on vector of discrepancies.
Thus it is important to form well-conditioned system of linear equations,
robust to disturbances in
,
caused by unaccounted factors.
In case of scalar calibration
i-th row in matrix
has following form:
|
(8)
|
The approach for conditioning improvement demands determining particular
angular orientations so that corresponding rows in calibration
matrix has minimal projection on other rows. This approach can be presented as
optimization problem (10) for projection function of newly formed row
on vector space of other row vectors in
by two angles
and
.
These angles define
vector of gravity acceleration
(9) in spherical coordinate system, bound to rotation pivot of
module (Fig.3).
.
|
(9)
|
.
|
(10)
|
Here
is a matrix with i-1 rows, formed earlier in the same way.
Composing calibration matrix by choosing module orientations according to
minimal points of projection function in (10) leads to improvement of the
resulting matrix
conditioning.
Fig. 3. Vector
defined in a spherical coordinate system.
The algorithm for composing such calibration matrix is
as follows: first measurement of perceived acceleration is taken in initial
position of module: alignment of OY axis is vertical, which corresponds to
angles
and
.
Second measurement is taken in such angular orientation, that
angles
and
of
minimize function from (10) with previously calculated row
representing the whole calibration matrix. Third measurement is
taken in orientation, that minimizes function from (10) for calculated rows
and
.
On following iterations newly acquired rows
are added to matrix
and projection function is recalculated. Overall, linear system of
at least 9 equations must be formed to estimate 9 error parameter deviations.
Applying optimization algorithm for function
requires preliminary visualization to determine its properties. 3D
plots of squared value of function
in area [0;
]
radians of parameters
and
are shown on Fig. 4.
Plots are made via CAS Maxima since calculations are done symbolically. The
figure includes 8 subsequent plots of squared value of
for each step in
which new optimal pair
is found.
The complexity of efficiency function increases as new rows
are added to calibration matrix. On each of 8 iterations initial
points are determined for optimization algorithm using visualization to find
,
which corresponds to new optimal orientation for module on current
iteration
i
(Fig. 4).
Visualization shows that in area from 0 to
radians of both parameters function is periodic on every step and
has several minimal points, therefore it is possible to chose several optimal
orientations. Initial point for optimization algorithm is picked from visual
representation of the efficiency function on every of 8 plots consequently and
determine which one of the available minimal points is found. One can also note
that after 4th measurement minimal function value jumps to non-zero value
showing that minimal possible condition number of calibration matrix
is lower bounded. Adding more angular positions increases minimal
function value as well.
The model considered in this paper doesn’t account for
asymmetry in scaling coefficients, so choosing from multiple points of minima
doesn’t matter. However, if scaling coefficients are estimated separately for
positive and negative projections of perceived acceleration, one can choose a
particular area of minima on plot which meets the requirement for module
orientation relative to reference acceleration vector.
Acquired set of 9 pairs
is translated into corresponding angles for actual gimbals of
sensor module (Table. 2). The scheme of gimbals system is on the Fig. 5.
Table 2. Optimal set of angles of orientation for gimbals.
Axes
|
1
|
2
|
3
|
4
|
5
|
6
|
7
|
8
|
9
|
Z,o
|
0
|
90.0074
|
-90.0000
|
-136.0061
|
138.6793
|
50.5226
|
135.177
|
-136.9260
|
-43.8877
|
X,o
|
0
|
-89.9926
|
0.5947
|
35.6601
|
36.9652
|
33.2264
|
-34.3200
|
-34.5039
|
36.9528
|
Y,o
|
0
|
90.0000
|
0.5947
|
77.0549
|
-83.1103
|
-16.0279
|
73.6480
|
-76.3967
|
15.3341
|
263.6104
|
Fig. 4. Function
for rows
,
.
A computer imitation of fixed base
calibration in case of non-optimal (Table 1) and new optimal (Table 2) set of
orientations was used to verify the method. Three virtual accelerometer formed
an array of gravity vector measurements in a given gimbals angular orientation.
The computer imitation designed in such way that sensors output errors are
defined by deviation of parameter vector
from its nominal value.
The values of deviation are set in
imitation program and provided in Table 3. After receiving measurements from
imitation, discrepancy between measured and expected values is calculated in
each angular orientation. With these discrepancy values vector
deviation and precision of calibration were estimated.
To compare estimation robustness in
both cases the measurements were taken with error in angular module orientation
equal for all axes. This error value was random, normally distributed with
expected value 0 and variance ranged from 0 to 600 arcsec. The average relative
estimation error for 200 calibration imitation repetitions were taken as
characteristic of accuracy for single orientation error variance value.
Fig. 5. Scheme of a gimbal system in initial
orientation.
The relation between relative estimation error for
different calibrated parameters and magnitude of errors in angular positioning
of module is shown on Fig. 6 (a, b, c).
Table 3. Nominal values of error model parameters and
their deviations in imitation program.
¹
|
Parameter
|
Value
|
Deviation value
|
1
|
θ
1
|
0o
|
10'
|
2
|
φ
1
|
0o
|
10'
|
3
|
υ
1
|
30''
|
10'
|
4
|
υ
2
|
30''
|
-10'
|
5
|
θ
3
|
0o
|
10'
|
6
|
φ
3
|
-90o
|
-10'
|
7
|
K
1
|
1
|
0,5%
|
8
|
K
2
|
1
|
0,5%
|
9
|
K
3
|
1
|
0,5%
|
10
|
b
1
|
0
|
10-3
m/s2
|
11
|
b
2
|
0
|
10-3
m/s2
|
12
|
b
3
|
0
|
10-3
m/s2
|
These plots show that scalar
calibration performed with optimal set of module orientations is in general
more robust to errors of angular positioning of module during the calibration.
Fig 6 (a) shows that in case of using optimal set of angular positions estimation
accuracy for parameters
and
are not affected by errors in module orientation in margin of 0 to
600 arcsec of mean error value, while in case of using a non-optimal set a
relative estimation error grows in linear manner in same margin. The relative
estimation error of parameter
in both cases doesn’t grow with increasing magnitude of errors in
module orientation. In overall, the relative error of estimation of all angular
parameters
(,
,
)
using optimal set of orientations is about 0.86%.
Fig. 6 (a). The relation between relative
estimation error for deviation of sensor alignment parameters and magnitude of
errors in angular positioning of module for non-optimal (dashed) and optimal
set of module orientations.
Fig. 6 (b). The relation
between relative estimation error for deviation of sensor scaling coefficients
and magnitude of errors in angular positioning of module for non-optimal
(dashed) and optimal (solid) set of module orientations.
Fig. 6 (c). The relation
between relative estimation error for deviation of sensor bias and magnitude of
errors in angular positioning of module for non-optimal (dashed) and optimal
(solid) set of module orientations.
Fig. 6 (b) and (c) show that
relative errors for scaling coefficients and biases are less robust to accuracy
of module alignment. In both cases these estimation errors grow linearly with
mean module alignment error. Note, that estimation accuracy of same parameters
for different accelerometers have different susceptibility to module alignment
errors, but in case of using optimal set this susceptibility becomes similar.
Also, with optimal set of orientations it is 2-10 times weaker than with non-optimal
set for scaling coefficients and 7-27 times weaker for biases. In overall, with
mean module alignment error of 600 arcsec, the relative estimation error for
scaling coefficients is about 0.4% and 7.5% for biases.
Calibration of accelerometer module
is an operation performed to determine the parameters of model, which describes
forming of measurement errors. In calibration on fixed base unaccounted factors
such as errors in module angular positioning lead to losses in calibration
accuracy. The effect of unaccounted factors on accuracy depends on problem
conditioning which, in its turn, is determined by used set of module
orientation. The paper present an approach for scalar calibration case to chose
a module set of orientations that is optimal in terms of problem conditioning.
An approach includes visual representation of function which characterize an
efficiency of calibration measurement made in each angular module position for
estimation of solution vector, the minimization of each function and
transformation of minimal point to Euler angles for gimbal positioning.
The method verified in computer simulation by comparison of accuracy using optimal and nonoptimal
sets of module orientations. The imitation of both cases was performed in
presence of errors in angles of module orientation in range from 0 to 600
arcsec. With optimized set of calibration orientations the estimation accuracy
for angular parameters (accelerometer alignment errors inside a module) is
non-susceptible to errors in module alignment during measurements, while in
case of using a non-optimized set the estimation accuracy of only one angular
parameter is not affected by these module alignment errors. Relative errors of
estimation for scaling coefficients and biases grow linearly with module
alignment errors for both cases. However with optimized set of orientations
this growth is 2-27 times slower in comparison with estimations done with
non-optimized set.
1.
Avrutov V. V., Mazepa T. Y. Vliyanie pogreshnosti
povorota stenda na tochnost’ kalibrovki bloka gyroskopov i akselerometrov —
Vestnik
NTUU
«KPI», seria
«PRIKLADOBORUDOVANIE», 2010, vol. 43, pp. 5-10.
2.
Särkkä, O., Nieminen, T., Suuriniemi,
S., & Kettunen, L. (2017). A Multi-Position Calibration Method for
Consumer-Grade Accelerometers, Gyroscopes, and Magnetometers to Field
Conditions. IEEE Sensors Journal, 17 (11), 3470-3481.
3.
Dao Wan BA, Le Wan Chang, Shalymov R. V.
Dinamicheskaya kalibrovka triady akselerometrov na dvukhosnom stende — Izvestia
SPbGETU «LETI», 2014, ¹ 8, pp. 72 — 76.
4.
Fomichev A.V., Kukhtevich S.E., Izmaylov E.A.
Resultati sovershenstvovania programmno-matematicheskogo obespechenia sistemy
BINS – SP-2 po materialam letnikh ispitaniy — Trudy Moskovskogo instytuta
electromekhaniki i avtomatiki. – OAO "MIEA", 2013, ¹ 7, pp. 19–29.
5.
Solovieva D.N. Opredelenie parametrov
pogreshnostei bloka akselerometrov dlya trekhosnoy gyrostabilizirovannoy
platformy – Trudy FGUP "NPCAP", 2012.
6.
Lakoza S.L., Meleshko V.V. Skalyarnaya
kalibrovka akselerometrov nizkoj i srednej tochnosti – Radiostroenie, 2015, ¹1.
7.
Avrutov V.V. O skalyarnoj kalibrovke bloka
akselerometrov i giroskopov — Vestnik NTUU «KPI», 2010, seriya
«PRIKLADOBORUDOVANIE», ¹. 40, pp. 10–17.
8.
M'int, H.N. Metod kalibrovki bloka
akselerometrov inercial'noj navigacionnoj sistemy na ispytatel'nom stende –
Nauka i obrazovanie: elektronnyj nauchno-tekhnicheskij zhurnal. – nauchnoe
izdanie MGTU im. N.E. Baumana, 2014, ¹1, pp. 38–54.
9.
Grebenkin M.D. Sravnenie metodov ocenki parametrov
pogreshnostej bloka akselerometrov trekhosnoj girostabilizirovannoj platformy —
Trudy FGUP "NPCAP". Sistemy i pribory upravleniya, 2017, ¹ 4, pp.
22-31
10.
Korobkov N. V. Podhody k opredeleniyu parametrov
akselerometrov v sostave GSP — Trudy FGUP "NPCAP", 2019, ¹ 1.
11.
Izmaylov E.A., Lepe S.N., Molchanov A.V.,
Polikovskiy E.F. Skaliarniy sposob kalibrovki i balansirovki besplatformennikh
inertsialnikh navigatsionnikh sistem — Jubilee 15th Saint Petersburg
International Conference on Integrated Navigation Systems, 26-28 May 2008,
Saint Petersburg, Russia. pp.145 — 154.
12.
Parusnikov, N.A., Tikhomirov, V.V.E. and
Trubnikov, S.A. Determination of instrument errors for inertial navigation
system on a stationary base — Fundamentalnaya i Prikladnaya Matematika. 2005.
11(7), pp.159-166.