1. Introduction
Inertial Navigation Systems (INSs) are specialized dead-reckoning systems which provide a standalone navigation solution for attitude, velocity, and position [
1]. Like any dead-reckoning system, INSs need to comply with a generally stationary initialization procedure, which, in the specific case of the attitude, is called alignment [
2,
3]. The very purpose of the alignment is to roughly estimate the attitude of the vehicle (or body) frame relative to the navigation frame, so that it can be used, and posteriorly corrected, by any filtering-based navigation/guidance stage deployed afterwards [
4]. As explained by Thompson, Farrell, and Knight [
5], the alignment requires the observation of, at least, two noncollinear vectors, whose components should be known in both body and navigation frames. Traditionally, the local gravity and Earth rate vectors, measured by stationary accelerometers and gyros, respectively, provided by an Inertial Measurement Unit (IMU), have been chosen for INS alignment purposes [
6].
Despite the recognized efficiency of the aforementioned approach, it requires high quality (navigation-grade) gyros to be employed, which are expensive and contrast with the current expansion trend toward commercial low-cost navigation applications [
7]. When low-cost IMUs are sought, a good candidate for replacing the Earth rate vector (for stationary alignment purposes) is the Earth magnetic flux density vector, which can be adequately observed by calibrated magnetometers [
8]. When three-axial magnetometers are incorporated into an IMU, the resulting sensor set is often referred to as Attitude and Heading Reference System (AHRS) [
9,
10], or yet, Magnetic, Angular Rate, and Gravity (MARG) sensor array [
11,
12]. AHRSs have been successfully employed in a vast range of applications, including, but not limited to, Unmanned Aerial Vehicle (UAV) attitude control/stabilization [
13], human body tracking [
14,
15], joint angle estimation [
16], and mobile communications [
17].
As in other INS-based integration approaches [
1], AHRSs also resort to filtering schemes in order to have their inertial and magnetic sensor measurements optimally combined. The Extended Kalman filter (EKF) is probably the most employed integration architecture, wherein the attitude can be recursively propagated/updated based either on a linearized error model [
1,
18] or a nonlinear quaternion model [
19,
20]. Regardless of the adopted model, augmenting the states in order to estimate additional systematic/correlated noise contributions present in the sensor outputs is a recommended procedure [
21]. Another modification that already proved to be effective consists in splitting the EKF in two separate filters, one devoted to tilt (pitch and roll) estimation and the other to that of heading [
20,
22]. Amongst the filtering-based AHRS integration architectures that do not employ EKFs (or its variants), stands out the Complementary Filter (CF), characterized by its efficient (although nonoptimal) operation and simplicity [
23]. While much research effort has been dedicated to the investigation of these filtering-based AHRS integration architectures, only few works have studied the attitude initialization step, i.e., the alignment, that precedes any of them (either as a requirement for initializing the nonlinear attitude quaternion model or to guarantee the adequacy of using a small angle approximation for the attitude error states). As previously mentioned, the alignment is generally conducted in stationary conditions and is based on the observation of, at least, two noncollinear vectors. This paper, hence, is not aimed at investigating filtering-based attitude determination methods for AHRSs, but instead, it focuses on the particular problem of stationary AHRS alignment.
As recently analyzed by Fan, Li, and Liu [
24], several attitude determination methods can be used to solve the AHRS stationary alignment problem. Among them, stands out the Three-Axis Attitude Determination (TRIAD)-based method, originally proposed by Black [
25]. Despite being a straightforward analytical method, TRIAD has the drawback of only accommodating two vector observations per attitude computation. To solve this issue, the QUaternion ESTimator (QUEST) has been proposed by Shuster [
26]. Based on Davenport’s work [
27], QUEST optimally solved Wahba’s problem [
28], becoming one of the most referred attitude determination methods so far [
29]. When applied to the particular case of AHRS stationary alignment, however, QUEST proved to be unable to dissociate magnetometer errors from the estimation of pitch and roll [
24,
30,
31]. A thorough investigation of the problem has not appeared in the literature afterwards. To overcome QUEST’s deficiency, Yun, Bachmann, and McGhee [
32] proposed the Factored Quaternion Algorithm (FQA). Despite not being an optimal method, FQA demonstrated to be superior in accuracy (for roll and pitch), as well as 25% faster than QUEST. More recent, but still nonoptimal, alternatives to FQA are the Algebraic QUaternion Algorithm (AQUA) [
11], the Super-fast Attitude of Accelerometer and Magnetometer (SAAM) [
33], and the Simple-Structured Quaternion Estimator (SSQE) [
34]. All of the latter claimed to reach the same accuracy as that of FQA but at an even lower computational cost.
Another attitude determination method, widely employed for AHRS stationary alignment purposes, is the Arc-TANgent (ATAN) solution [
35]. Differently from TRIAD, QUEST, and FQA, which provide their attitude estimates in terms of Direction Cosine Matrices (DCM) and quaternions, respectively, ATAN calculates Euler angles directly, being hence susceptible to singularity problems [
36]. Due to its simplicity, however, ATAN has been vastly used in the literature, both for the purpose of the AHRS stationary alignment [
37,
38,
39,
40], as for the attitude determination thereafter (i.e., in the navigation stage). In the latter case, ATAN’s attitude solution has been combined with solutions from different sensors/systems, both in a Complementary Filtering (CF) fashion [
7,
12,
41,
42] and Kalman Filtering (KF) fashion [
19,
43,
44,
45].
Even though the aforementioned AHRS stationary alignment approaches have been tested and validated in previous works, very little knowledge is available in the current literature about the analytic description of the residual errors remaining after the alignment or the benefits/drawbacks of each approach (from the analytical standpoint). In [
46], for instance, a simplified overview of the main error sources affecting ATAN’s heading determination has been provided, but no mathematical background corroborated it. In [
47], the analytical description of ATAN’s heading error has been proposed, as a function of the magnetometer (bias, scale factor, and cross-coupling) errors and the Earth magnetic model (declination angle) error. The drawbacks of the analysis, however, are: (a) it was only valid for two-axial (levelled) stationary AHRSs, and (b) the heading error equation was derived w.r.t. the magnetic heading, not to the true heading. Liu et al. [
48] improved the aforementioned error analysis, by deriving a closed-form formula for ATAN’s heading error in a three-axial (nonlevelled) stationary AHRS application. Again, the analysis was confined to the magnetic heading error, which was equated as a function of the true pitch, roll and heading angles and not as a function of the magnetometer and Earth model parameter errors (which would have been more relevant). Even more simplified (or generic) analytical descriptions of ATAN’s (and QUEST’s) errors can be found in [
1,
29,
44,
49,
50,
51,
52,
53], which, however, do not provide much insight into the problem.
Apart from the above-mentioned works, most of the AHRS stationary alignment error analyses reported in the literature are solely based on numerical (simulated and/or experimental) results [
54,
55]. As an example, we may cite the work of Hu et al. [
56], which numerically evaluated the impact of sensor cross-coupling and tilt errors in ATAN’s computed heading. Včelák et al. [
57,
58] improved Hu’s work, by also considering the detrimental effects of temperature variation. In [
24,
59,
60,
61,
62], the authors numerically investigated the azimuth errors caused by changes in the magnetic field direction (i.e., in the declination and inclination angles), as well as variations (in the magnetic field magnitude) caused by common objects (i.e., hard-iron and soft-iron magnetisms). Sotak [
38], Kuga and Carrara [
30], and Del Rosario, Lovell and Redmond [
42], in turn, evaluated the detrimental impact of accelerometer and magnetometer biases, as well as, scale factor errors, in ATAN, QUEST, and TRIAD, respectively. Bistrov [
39], lastly, numerically analyzed the effect of sensor measurement noise in ATAN’s estimates. Even if the preceding numerical analyses are relevant, they are incomplete if not accompanied by a solid theoretical (analytical or stochastic) background. As a consequence, they can lead to misleading conclusions, as will be discussed throughout this paper.
To address the aforementioned issues, this paper presents an innovative and comprehensive analytical error description of four of the most employed attitude determination approaches for AHRS stationary alignment purposes, namely, TRIAD, QUEST, FQA, and ATAN. The main contribution of this paper is the derivation of novel closed-form formulae for the residual alignment errors developed in the corresponding DCM attitude solutions. For the purpose of the error analysis, errors in the accelerometers (constant biases), magnetometers (combined effect of constant biases and hard-iron magnetism), local gravity model, and Earth magnetic field model (flux density magnitude, declination angle, and inclination angle) are considered. Following the development of the closed-form formulae, a clarifying insight is provided into the AHRS stationary alignment problem, allowing us to compare the performance (in terms of ultimate accuracy) of the investigated algorithms properly, as well as to remove some misconceptions reported in previous works.
The remainder of this paper is organized as follows:
Section 2 reviews TRIAD, QUEST, FQA, and ATAN algorithms.
Section 3, in sequence, presents the procedures used to derive the novel closed-form formulae for the DCM residual errors, as well as the error analysis itself.
Section 4 and
Section 5 provide results from simulated and experimental tests, respectively, whilst
Section 6 concludes the paper.
3. Error Analysis
Regardless of the adopted approach, all AHRS stationary alignment algorithms presented in
Section 2 rely on the same assumptions: vehicle perfectly stationary, sensors uncorrupted, and external information (local gravity and Earth magnetic field models) accurately known. Obviously, none of these assumptions is satisfied in real world conditions, which means that only a corrupted estimate of the true initial attitude can be obtained.
For the analysis that follows, let us assume that the true attitude is provided in terms of the
DCM. Without loss of generality, we can equate the corrupted
to
as [
66],
where
I is the identity matrix, and
and
E are two representations of
errors.
As derived in [
66,
67,
68], the following relations hold, to first order in
E,
with,
where
,
, and
are the DCM normality, orthogonality, and alignment error vectors, respectively.
To develop an innovative and comprehensive error analysis for the AHRS stationary alignment formulations presented in
Section 2, we can expand their true
descriptions by linear perturbation technique,
where
represents the error (Throughout this paper, and for the purpose of the error analysis herein presented, the errors in the investigated variables (sensor readings and gravity/Earth magnetic field model parameters) are assumed to be constant, i.e., systematic biases.) in the generic (scalar or matrix) variable
x.
After analytically solving (
52), for each alignment method, the result, substituted in (
49), and then in (
50) and (
51), can be used to produce novel closed-form formulae for the DCM residual normality, orthogonality, and alignment errors. Unfortunately, for the purpose of the error analysis herein proposed, an arbitrary orientation of the body frame w.r.t. the navigation frame produces closed-form formulae which are overly complicated and not readily amenable to physical interpretation. For simplification purposes hence, hereinafter, we will assume that body and navigation frames are aligned.
Figure 1 summarizes the main steps involved in the process of deriving the closed-form formulae for the residual DCM errors for each investigated AHRS stationary alignment method.
3.1. TRIAD Method
Solving (
52) for TRIAD’s
, and substituting the result (jointly with (
10)) in (
49) to (
51), yields the following closed-form formulae for the residual errors,
where
t stands for tangent.
As (
53) to (
58) indicate, residual normality and orthogonality errors are developed in TRIAD’s DCM. According to Choukroun et al. [
69], these errors are highly undesirable, as they collaborate to propagate errors in the vector transformation operations conducted at high computational rates (as it is the case in AHRSs). As (
50) indicates, however, the normality and orthogonality errors can be estimated, to first order, uniquely from the computed
, and hence, they are easily compensated in practical implementations [
70,
71]. Alternatively, a more interesting application for the normality and orthogonality errors consists in using their first order estimates to produce coarse (or pseudo) estimates for some of the sensor biases. As (
53) to (
58) clearly indicate, there is a linear relationship between the residual
normality and
o orthogonality errors, and the underlying
accelerometer and
magnetometer biases corrupting the alignment. By using the former (normality/orthogonality errors) as a set of “pseudo"-measurements clearly casts the set of equations (
53) to (
58) into a least-squares framework, for which solutions can be estimated in terms of some of the sensor biases. A similar idea has been successfully used in [
72] for estimating accelerometer and gyro biases, in [
73] for accelerometer and magnetometer biases and in [
74] for accelerometer and dual-antennae Global Navigation Satellite System (GNSS) baseline biases.
Unlike the normality and orthogonality errors, which can be estimated and compensated, the alignment errors cannot, and hence, are of greater concern. As suggested in [
75], this is due to an observability deficiency of the AHRS stationary alignment, which prevents the latter from being properly estimated (and compensated), even in posterior Kalman-filter-based integration schemes. As (
59) to (
61) indicate, almost all of the investigated error sources contribute to the development of alignment errors in TRIAD’s
. It is worth noting, however, that the error terms weighed by
tends to be less detrimental, since, as analyzed by Chulliat et al. [
76], the value of
rarely exceeds ±20 deg in terrestrial applications. Despite this, caution is advised when analyzing the provided equations. In (
59), for instance, even though
is weighted by
, its effect on
can be very significant, especially in the presence of hard-iron magnetism. As explained by Zhang and Yang [
77], this magnetism is created by nearby man-made objects (including the navigational equipment itself) and is indistinguishable from the magnetometer bias. In the error analysis presented in this paper, hence,
represents the cumulative effect of constant magnetometer biases and hard-iron magnetism.
When the related literature is consulted, it is found that (
59) to (
61) also bring relevant clarifications about TRIAD’s accuracy (for AHRS stationary alignment purposes). Equations (
59) and (
60), for instance, clearly demonstrate that the north and east alignment errors are corrupted not only by accelerometer errors, as claimed in [
24,
32] but also by magnetometer, gravity, and Earth magnetic field model errors. Equation (
61), in sequence, demonstrates that the down alignment error is corrupted by both accelerometer and magnetometer errors, although the former are generally negligible, compared to the latter (i.e.,
). None of these relations had been addressed in previous works [
47,
48]. Additionally, (
61) provides conclusive evidence for the heading error behavior numerically reported in [
59,
60], according to which
seemed to vary, in magnitude, equal to the amount of the magnetic field deviation in the horizontal plane (
).
Lastly, it is worth noting that the error terms weighted by in the preceding formulae tend to be negligible at low latitudes. As the latitude increases, however, also does the value of , causing the residual alignment errors to be dramatically magnified (this is the main reason why the alignment is not practical near the Earth poles). Geometrically speaking, at the poles, the gravity and Earth magnetic flux density vectors become collinear, invalidating the fundamental assumption behind TRIAD.
3.2. QUEST Method
If an error analysis, similar to the one conducted for TRIAD, is developed for QUEST, i.e., if we apply (
52) in (
20) and substitute the result in (
49) to (
51), the following closed-form formulae arise for the DCM residual errors,
As (
62) indicates, no normality and orthogonality errors are developed in QUEST’s DCM. This corroborates [
67], which already had demonstrated that any quaternion parametrization of attitude, when converted to DCM, does not propagate normality and orthogonality errors (as long as the quaternion unit norm constraint is conserved). As previously mentioned, these errors are easily removed from the computed DCM, so, QUEST’s ability of not generating them is only significant from the computational efficiency standpoint. Equations (
63) to (
65), in turn, are more relevant, as they provide analytical proof to a behavior that, hitherto, had been only numerically demonstrated [
32]. As (
63) and (
64) indicate (in comparison to (
59) and (
60)), QUEST’s north and east alignment errors are no longer corrupted by
,
and
error terms, but instead, by
and
. As already explained, this may be very detrimental to be accuracy of
and
, especially in the presence of hard-iron magnetism.
Another interesting evidence from (
63) and (
64) is: the detrimental impact of the magnetometer biases in
and
is basically dictated by
, which, as already defined, is the weight QUEST attributes to the magnetometer vector observations. As a general rule, the larger
, the worse (more biased)
and
will be. While this tells us that less biased estimates could be obtained by decreasing
, at the limit, where
, the attitude solution would become indeterminate, as only one vector (
) would remain being observed. These verifications are innovative and very enlightening, especially when compared to the results of other error analyses presented so far, whose results lack physical interpretation [
29,
53]. QUEST’s down alignment error, lastly, is expected to reach the same accuracy as that of TRIAD (see (
61) and (
65)), which corroborates the numerical results given in [
32].
3.3. FQA/ATAN Methods
Closed-form formulae for the residual errors developed in FQA’s DCM can also be formulated. For this, it suffices applying (
52) in (
37), and substituting the result in (
49) to (
51). The outcomes are,
As (
66) indicates, no normality and orthogonality errors are developed in FQA’s DCM. Again, this corroborates theory [
67], as FQA’s attitude solution is primarily given in terms of a quaternion. Equations (
67) and (
68), in turn, contrast to the conclusions of Yun, Bachmann, and McGuee [
32], according to which FQA and TRIAD were said to have similar accuracies. As (
67) to (
69), in comparison to (
59) and (
61), clearly indicate, this is only true for
, as FQA’s
and
are not corrupted by magnetometer errors, neither by variations in the Earth magnetic field model. Another interesting verification is that FAQ’s
and
accuracies are similar to those of QUEST, for the particular scenario of
. As this would result in an indeterminate solution for QUEST, is it straightforward to conclude therefore that FQA’s accuracy is globally superior to that of QUEST (and ergo, of TRIAD).
Finally, closed-form formulae for ATAN’s DCM residual errors can be also derived. In this case, (
42), (
43), (
45), and (
47) are substituted in (
40) and the result, used for solving (
52). After substitution in (
49) and (
51), the conclusions are: ATAN’s error equations are exactly the same as those derived for FQA (for brevity, therefore, they are not repeated here). This verification confirms the results numerically obtained in [
42], according to which ATAN’s north and east alignment errors proved not to be corrupted by magnetometer errors, neither by variations in the Earth magnetic field model. Since ATAN provides the same accuracy as FQA, which is, by inspection, better than TRIAD and QUEST, also ATAN is superior to the latter. From the computational efficiency standpoint, however, FQA can still be considered superior to ATAN, since, as suggested in [
32], it avoids the explicit computation of trigonometric functions.
4. Simulation Results
To evaluate the innovative error analysis presented in
Section 3, as well as the outlined verifications, a simulated test was carried out. For the purpose of the test, accelerometer and magnetometer data were generated at 100 Hz, considering the ideal scenario of body and navigation frames perfectly aligned. The accelerometers and magnetometers were purposely corrupted by 5 mg and 5 mG of constant biases, as well as by white random noises with root Power Spectral Densities (PSDs) of 0.1 mg/
and 0.2 mG/
, respectively. These values were chosen as they correspond to typical error parameters of automotive-grade AHRSs found in manufacturer data-sheets (see
Section 5) and textbooks [
1]. The sensors were simulated at latitude −23.2131 deg, longitude −45.8606 deg, and altitude 629 m. The local gravity acceleration and Earth magnetic field were calculated according to the models described in [
76,
78], respectively. Corresponding errors (constant biases) of 0.005 mg, 0.1 mG, 0.1 deg, and 0.1 deg were purposely added in the values of gravity, Earth magnetic flux density magnitude, declination angle, and inclination angle, respectively.
For the purpose of the test, we compared TRIAD, QUEST, FQA, and ATAN, in terms of the achieved AHRS stationry alignment accuracies. For QUEST, particularly, values of
and
were chosen, following the methodology suggested in [
79,
80]. Based on the simulated values for the sensor, gravity, and Earth magnetic field errors, the closed-form formulae derived in
Section 3 were used to generate predictions for the DCM residual normality, orthogonality, and alignment errors (
Table 1).
Figure 2 depicts the estimated errors as function of time, where a continuous averaging of the sensor outputs has been adopted, in order to smooth the noise.
Table 2 summarizes the errors estimated at the completion of the simulated test, as well as the associated standard uncertainties (The standard uncertainties represent the coverage intervals within which the true values of the estimates are expected to lie (with a level of confidence of 95%, i.e., coverage factor of 2 [
81]). In this paper, the standard uncertainties have been computed by dividing the standard deviations of the estimates (characterizing their dispersion about their mean values) by the square root of the number of observations. According to [
81], this corresponds to the Type A evaluation of standard uncertainty, i.e., standard uncertainties obtained experimentally, by the statistical analysis of series of observations.).
As can be seen, the estimated errors nicely agree with the predicted ones (confidence intervals experimentally obtained in
Table 2 encompass the predicted values in
Table 1), which validates the proposed error analysis.
Figure 2a–f, in particular, indicate that only TRIAD develops normality and orthogonality errors in the computed DCM (as expected).
Figure 2g,h, in turn, demonstrate that, while FQA’s and ATAN’s north and east alignment errors are only corrupted by accelerometer errors, those from TRIAD and QUEST also depend on magnetometer biases, as well as on gravity and Earth magnetic field model errors. In the specific case of QUEST, the north and east alignment errors are found to be further dependent on
. Lastly,
Figure 2i evidences that, as predicted, no difference exists, in terms of accuracy, between the down alignment error developed in TRIAD’s, QUEST’s, FQA’s, and ATAN’s computed DCM.
Regarding the standard uncertainties of the estimated DCM errors,
Table 2 clearly shows that larger (i.e., more uncertain) values are expected to exist for errors that depend on magnetometer readings (see
and
for TRIAD and QUEST, for instance). A statistical and more appropriate way of characterizing the dispersions (i.e., the standard uncertainties) of the estimated DCM errors around their predicted values is using a Monte Carlo simulation. To perform the latter, 10,000 statistically independent simulated runs (of ten seconds each) were repeated (This number of Monte Carlo runs has been chosen based on a trade-off between its ability of adequately recuperating the Probability Density Function (PDF) of the simulated noise and the computational effort. It is in agreement with previous works published in the area [
19,
43,
50,
82,
83,
84], as well as with [
85].), whereas the main input parameters for the simulation were allowed to vary (randomly) according to the standard deviations summarized in
Table 3. The predicted and estimated DCM errors obtained at the completion of each run were saved and subtracted from one another. The mean values and standard uncertainties of the formed differences (deviations) are summarized in
Table 4.
As can be seen, the mean values of all DCM error deviations (estimated minus predicted values) are close zero, indicating that the closed-form formulae derived in
Section 3 are statically reliable (unbiased) estimators of the current DCM residual errors. The obtained standard uncertainties, in turn, follow the same pattern evidenced for the standard uncertainties of
Table 2, i.e., closed-form formulae that are independent on magnetometer errors are expected to be less uncertain.
5. Experimental Results
To verify the results achieved in the simulated tests, an experimental test was conducted. The employed AHRS, namely, an automotive-grade M2 unit from Innalabs
®, was mounted aligned to the navigation frame on a semispherical three degrees of freedom (3-DOF) air bearing [
86], as depicted in
Figure 3. The test was conducted at the Brazilian National Institute for Space Research (INPE), in São José dos Campos, Brazil. The geographic coordinates of the site are: −23.2113 deg of latitude, −45.1408 of longitude, and 641 m of altitude.
To compensate the sensor data (magnetometers, in particular) for residual scale factor/cross-coupling errors and soft-iron magnetism, which are not accounted for in the error analysis presented in this paper, the latter were precalibrated using the algorithm proposed in [
87]. In sequence, a stationary sample of the precalibrated data was continuously averaged over about ten seconds (producing
and
), and estimates for the
local gravity and
Earth magnetic flux density vectors were computed (using the models described in [
78,
88], respectively). Since, in the concerned test, the AHRS was mounted aligned to the navigation frame, the following relations held (The accuracy in these approximations is basically limited to the accuracy of the semispherical 3-DOF air bearing rotating mechanisms [
86].):
and
. Thus, by numerically subtracting
and
from the calibrated
and
, respectively, coarse estimates for the residual constant biases corrupting the outputs of the accelerometers and magnetometers were obtained, namely,
By substituting (
70) and (
71) into the closed-form formulae derived in
Section 3 and also (purposely) considering the existence of errors (constant biases) of 0.005 mg, 0.1 mG, 0.1 deg, and 0.1 deg, in the values of gravity, and Earth magnetic flux density magnitude, declination angle, and inclination angle, respectively, predictions were obtained for the DCM residual errors in the experimental test (
Table 5).
Figure 4 presents the estimated errors as function of time, while
Table 6 summarizes the errors at the completion of the experimental test alongside their standard uncertainties.
As can be noticed, the estimated errors corroborate the predicted ones, following the same pattern evidenced in the single-run simulated test. Differently from
Section 4, we verify now that the confidence intervals fail to encompass all the predicted values (in general, by a very small amount). This, however, is consistent, as the predicted DCM errors were not computed based on the true (and in this case, unknown) values of the sensor biases (as done in
Section 4) but instead only on the coarse estimates of (
70) and (
71). These results, hence, confirm the validity of the innovative error analysis proposed in this paper, as well as the outlined verifications about TRIAD’s, QUEST’s, FQA’s, and ATAN’s accuracies for AHRS stationary alignment purposes.
6. Conclusions
In this paper, four well established attitude determination algorithms for Attitude and Heading Reference Systems (AHRSs) stationary alignment have been reviewed, namely, the Three-Axis Attitude Determination (TRIAD)-based method, the QUaternion ESTimator (QUEST), the Factored Quaternion Algorithm (FQA), and the Arc-TANgent (ATAN) solution. A detailed and innovative error analysis has been proposed, considering the ideal assumption of body and navigation frames perfectly aligned. For the purpose of the latter, we considered errors in the accelerometer/magnetometer readings (cumulative effect of constant biases and hard-iron magnetism) and in the gravity/Earth magnetic field models (flux density magnitude, declination angle, and inclination angle). As the main contribution of this study, novel closed-form formulae for the Direction Cosine Matrix (DCM) residual errors (normality, orthogonality, and alignment errors) were analytically derived. These formulae brought analytical insight into the problem, allowing us to compare the performance of the investigated alignment formulations (in terms of ultimate accuracy) as well as to remove some misconceptions reported in previous works.
As main conclusions of this investigation, we may summarize: (a) TRIAD is the sole algorithm producing normality and orthogonality errors in the computed DCM; (b) FQA’s and ATAN’s north and east alignment errors are uniquely caused by y- and x-axis accelerometer biases, respectively; (c) larger north and east alignment errors are expected to exist when using TRIAD and QUEST, as the latter are also function of the magnetometer biases, the inclination angle error, and the error in the Earth magnetic flux density magnitude; (d) in the specific case of QUEST, the detrimental effect of magnetometer biases in the north and east alignment errors are weighted by ; (e) the DCM down alignment error is the same for all investigated approaches and is mainly caused by x- and y-axis magnetometer biases, as well as the declination angle error.
As suggestions for future work, the authors plan to expand their error analysis for the generic case of body and navigation frames arbitrarily oriented, which is more relevant for practical implementations. In this sense, it is found that a procedure similar to the one presented in [
72,
89] can be adopted. Moreover, the consideration of scale factor/cross-coupling errors (which would include misalignments and soft-iron effects for the magnetometers) also seems a topic worthy of future investigation.