1. Introduction
The inertial navigation system (INS) continuously provides attitude, velocity and position of a vehicle from specific force and angular velocity measured by an inertial measurement unit (IMU) [
1,
2,
3]. Since the INS has high output rate and wide bandwidth, it has been widely used as a navigation system of vehicles with high dynamics such as rocket, guided missile and aircraft [
4].
Initial attitude, initial velocity, and initial position must be known before the navigation is carried out since the INS calculates a navigation solution by integrating IMU measurements
. The initial velocity and initial position should be provided externally. On the other hand, initial attitude can be determined in stationary state by itself from the gravity and the earth rate measured by the IMU [
2]. This initial attitude determination without external aiding is called self-alignment [
5]. In the gimbaled INS (GINS), the self-alignment is a procedure which aligns physically the platform with the navigation frame using gimbals. The self- alignment in the strap-down INS (SDINS) is a procedure to determine the initial attitude represented by the direction cosine matrix (DCM) between the body frame and the navigation frame or Euler angles, roll, pitch and heading.
The GF-INS is an inertial navigation system which uses only accelerometers. Shuler first proposed in 1960s the idea which measures angular motion of a vehicle using the lever-arm effect of accelerometer [
6]. However, subsequent researches were not followed since quality of the accelerometer was not good enough to completely replace the gyroscope. With the development of micro-electro-mechanical system (MEMS) technology, nanotechnology and cold atomic technology from late 1990s, researchers have paid much attention to the GF-INS [
7,
8].
Before performing navigation, attitude should be initialized in the GF-INS as in the conventional INS. Even though self-alignment algorithm for the conventional INS is available, it cannot be used as it is since the measuring method of angular motion for a vehicle in the GF-INS is fundamentally different from that of the conventional INS.
Vaknin and Klein derived a partial coarse alignment procedure for the roll and pitch only and developed closed form expressions for the angular error of the GF-INS coarse alignment [
9]. They compared the partial coarse alignment performances between different GF configurations. Vaknin and Klein claimed that a useful initial heading cannot be obtained regardless of the accelerometer grade since GF-INS is not able to directly measure the earth rate [
9].
In this paper, a coarse alignment of the GF-INS is presented, and the feasibility of the initial heading is evaluated. The initial heading expression in accelerometer outputs of the GF-IMU is derived from the initial heading expression in the coarse alignment of the conventional INS. The configurations of the GF-IMU, in which the initial heading expression can be obtained, are investigated among the configurations of the GF-IMU in literatures [
9,
10,
11,
12,
13,
14,
15]. A relation between accelerometer error and initial heading error is derived. In addition to these, initial heading expression is derived when one or two gyroscopes are added in the axes of the body frame to the GF-IMU. Relation between accelerometer of GF-IMU and gyroscope errors and initial heading error are also derived.
Organization of this paper is as follows. In section2, coarse alignment equations for the conventional INS is introduced. In section 3, the coarse alignment of the GF-INS is described. In section 4, the coarse alignment of the GF-INS is described when gyroscopes are added to the GF-IMU. Finally concluding remarks and further studies are presented in section 5.
2. Coarse Alignment of INS
2.1. Leveling
Only gravity is measured by the accelerometer when the vehicle is stationary. The measured gravity is represented in Equation (1) between the body frame and the navigation frame [
16,
17,
18].
where
,
and
are roll, pitch and heading, respectively.
denotes gravity.
and
are the specific force represented in the body frame and the navigation frame, respectively.
denotes the DCM between the navigation frame and the body frame.
,
and
denote DCMs between two frames when the frame is rotated
,
, and
around yaw, pitch, and roll axes, respectively.
Roll can be obtained as Equation (2) from Equation (1) [
16,
17,
18].
where
and
are the
axis and the
axis component the specific force, respectively. Pitch
is obtained from Equation (3) [
16,
17,
18].
where
is the
axis component of the specific force.
2.2. Gyrocompassing
Only the earth rate is measured by the gyroscope when the vehicle is stationary. The earth rate is represented as Equation (4) in the body frame and in the navigation frame [
16,
17,
18].
where
and
are the magnitude of the earth rate and the latitude, respectively.
and
are the earth rate represented in the body frame and navigation frame, respectively. From Equation (4), the earth rate
represented in the frame, which is rotated from the navigation frame by the heading
, is given in Equation (5) [
16,
17,
18].
From Equation (5), the heading is obtained from Equation (6) [
16,
17,
18].
3. Coarse Alignment of GF-INS
3.1. Roll and pitch
The
-th accelerometer output of the GF-IMU with
accelerometers is given in Equation (7) [
10].
where
denotes the sensing direction of the
-th accelerometer.
is the specific force of the
-th accelerometer represented in the body frame.
is the acceleration at the center of the gravity of the vehicle represented in the body frame.
is the angular velocity of the body frame with respect to the inertial frame represented in the body frame.
is the angular acceleration of the body frame with respect to the inertial frame represented in the body frame.
is the position of the
-th accelerometer represented in the body frame.
is the gravity vector represented in the body frame. If the vehicle is stationary on earth, then
,
and
. Therefore, the
-th accelerometer output can be represented in Equation (8).
In Equation (8), since the magnitude of the vector
,
is
s, the magnitude of the centripetal acceleration is much less than the gravity as Equation (9) [
9].
As a result of this, Equation (9) can be represented in Equation (10) [
9].
The estimated specific force
from
accelerometers outputs can be obtained from Equation (11).
where
is the sensing direction matrix of the accelerometers in (12).
is the accelerometer measurement vector in (13).
Inserting the specific force in Equation (11) into Equation (2) and (3), roll and pitch can be obtained.
3.2. Heading
In order to obtain heading, let's change Equation (8) to Equation (14).
where
,
, and
are
,
, and
axis component of
, respectively.
is the skew symmetric matrix of the vector
.
,
and
are
,
and
axis component of the sensing direction of the
-th accelerometer, respectively.
Rearranging Equation (14), Equation (15) can be obtained.
where
is given in Equation (16).
If all the
accelerometer outputs of the GF-MU are put together, Equation (17) can be obtained from Equation (15).
From Equation (17),
can be obtained as Equation (18).
The heading can be obtained as Equation (19) from Equation (6) and
of Equation (18).
3.3. Accelerometer configuration and possiblity of initial heading calculation
In this section, it is investigated using Equation (19) in section 3.2 whether the initial heading can be calculated for the accelerometer arrangements of GF-IMUs which have been presented in literatures [
9,
10,
11,
12,
13,
14,
15].
Figure 1,
Figure 2,
Figure 3 and
Figure 4 shows 6 arrangements with 6 accelerometers, one arrangement with 7 accelerometers, 6 arrangements with 9 accelerometers and 2 arrangements with 12 accelerometers of GF-IMUs, respectively. In
Figure 1,
Figure 2,
Figure 3 and
Figure 4, black arrows indicate
,
, and
axes of the body frame, respectively. Blue dots indicate positions of accelerometers and blue arrows sensing directions of accelerometers.
If
can be obtained from Equation (18), the initial heading can be obtained from Equation (19). In order to obtain
, rank of the matrix
should be 6. Ranks of the matrix
for the arrangements in
Figure 1,
Figure 2,
Figure 3 and
Figure 4 are listed in
Table 1.
It can be seen from
Table 1 that the initial heading can be obtained from Equation (19) when the accelerometer arrangements are given in
Figure 3e and a.
,
, and
for the initial heading calculation for the accelerometer arrangement in
Figure 3e are given in Equation (20), (21), and (22), respectively.
where
is given in Equation (23).
denotes distance from the center of gravity (accelerometer 9) to the accelerometer 1 to 8.
,
and
for the initial heading calculation for the accelerometer arrangement in
Figure 4a are given in Equation (24), (25), and (26), respectively.
where
is given in Equation (23).
denotes distance from the center of gravity (accelerometer 1 to 3) to the accelerometer 4 to 12.
3.4. Initial heading error
Let us check the initial heading error when the initial heading is obtained using the method in section 3.3. Accelerometer output
can be represented in Equation (27).
where
denotes error of the
-th accelerometer output. If Equation (17) is used,
can be represented in Equation (28) from accelerometer output
in Equation (27) and
in Equation (11).
where
is the estimate of
from accelerometer outputs. Error
of
can be represented in Equation (29) from Equation (18) and Equation (28).
where
and
denote errors of
and
, respectively. Covariance of
, can be obtained in Equation (30) from Equation (29).
where covariance of
is given in Equation (31) since
if
.
where
denotes variance of
. Let us calculate variances of
,
, and
given in Equation (20) ~ (26). If accelerometers with the same specification are used, Equation (30) can be represented in Equation (32) since the condition
is valid.
Variances of
,
, and
are listed in
Table 2 for
Figure 3e and
Figure 4a from Equation (32).
Consider the initial heading error of the generic INS alignment to check the initial heading error of the GF-INS alignment. The gyroscope output in the navigation frame can be expressed in Equation (33) when the vehicle is stationary.
where
denotes the gyroscope output in the navigation frame and
the gyroscope output error in the body frame.
If roll, pitch, and heading are sufficiently small,
can be expressed in Equation (34).
where
,
, and
denote sufficiently small roll, pitch, and heading, respectively. In order to make the description simple, it is assumed that the body frame and the navigation frame are the same, i.e.
. Then, Equation (33) can be written in Equation (35).
In order to obtain heading in the initial alignment, the east component of the gyroscope output (
) should be zero as Equation (36).
can be written in Equation (37) when
in Equation (36)
It can be seen from Equation (37) that the initial heading error in the generic INS is proportional to the gyroscope error of the east direction (the pitch axis direction) and inversely proportional to
when the body frame is the same as the navigation frame. Therefore, the heading error is minimum when the vehicle is located at the equator and the heading error increases as the vehicle becomes nearer the pole (
deg).
Now, let us consider the initial heading error of the GF-INS.
of Equation (29) is given in Equation (38) when the body frame is the same as the navigation frame.
Therefore, Equation (37) can be represented as Equation (39) using Equation (38).
It can be seen from Equation (39) that the heading error is proportional to
which is error of
obtained from Equation (29) and it is impossible to get the heading at the pole as Equation (37) when the initial alignment is performed using Equation (19).
Since
depends on the grade and arrangement of accelerometers whether the initial heading of the GF-INS can be obtained is checked for the arrangements in
Figure 3e and
Figure 4a and accelerometers in
Table 3 [
19,
20].
Let us obtain heading error for the accelerometers in
Table 3 when
deg and
m. In order to check the effect of accelerometer error to the heading error,
can be expressed in accelerometer error
as Equation (40) when
in Equation (29)
Since
), 1
of
can be obtained when specifications of the accelerometers in
Table 3 are inserted into
Table 2. By inserting these values into Equation (39), 1
values of the initial heading errors to the accelerometer errors are in
Table 4.
It can be seen from
Table 4 that the initial alignment of GF-INS cannot be performed even when absolute quantum gravimeter which is the most precise accelerometer in the present technology level as well as navigation grade accelerometer are used since the heading error is very large. For the 1
of the heading error in the arrangement of
Figure 4a to be less than 5 deg, the precision of the accelerometer should be less than
G. This value is 15 times more precise than the absolute quantum gravimeter in
Table 3. It can be seen from these results that it is difficult to have a required performance in the heading coarse alignment of the GF-INS and these results are similar to the mentioning by Vaknin and Klein that the initial heading cannot be obtained [
7,
9].
In order to resolve this problem, it can be considered to add one gyroscope or two gyroscopes to the GF-MU as described in the next section.
4. Coarse Alignment of GF-INS with Gyro
According to the results in section 3, it can be considered to perform the coarse alignment after one or two gyroscopes are attached to the roll, pitch or yaw axes of the vehicle to the arrangement of the accelerometers since obtaining the initial heading is not feasible using only the arrangement of accelerometers.
The gyroscope output
can be expressed in Equation (41) in the body frame.
where
denotes
axis gyroscope output error in the body frame.
Relationship between gyroscope output and
in Equation (18) is given in Equation (42).
where
denotes
unit matrix. Inserting Equation (41) into Equation (42), error of
is given in Equation (43).
It can be observed from Equation (43) that the error of
is proportional to the gyroscope outputs
,
, and
.
For simple description, consider the case that
deg and the body frame is the same as the navigation frame. In this case, Equation (43) can be represented in Equation (44) since
.
can be estimated in Equation (45) using
calculated from accelerometer outputs and gyroscope outputs
.
where
denotes weight matrix given in Equation (46).
where
is covariance of
and
is variance of
. Measurement matrix
is given in Equation (47).
where
and
are measurement matrices of accelerometer output and gyroscope output, respectively.
The number of arrangements of gyroscopes, in which the gyroscopes are located at one or two axes among roll, pitch, and yaw axes, is 6 in the body frame. One gyroscope can be located at the roll, pitch or yaw axis and two gyroscopes can be located at the roll and pitch axes, roll and yaw axes or pitch and yaw axes.
,
and
in Equation (45) for the gyroscope arrangements are listed in
Table 5. Error covariance of the estimated
in Equation (45) is given in Equation (48).
For the accelerometer arrangement in Figure 5a, heading error can be checked when the initial heading is obtained using accelerometer outputs and added gyroscope outputs. Variances of
,
, and
from Equation (48) are listed in
Table 6.
It can be seen from
Table 6 that variance of
is the same as the case that only accelerometers are used except that the case when the added gyroscopes are located at the roll and pitch axes. Since the heading error is determined by
as shown in Equation (39), the additional gyroscopes should be located at the roll and pitch axes in order to have more accurate initial heading of the GF-INS.
Let us obtain variance of
to the grade of the gyroscope in order to have heading error. First, the variance of
in Equation (44) is given in Equation (49).
When the gyroscopes with the same error specifications are located at the roll and pitch axes, variance of
is in Equation (50) since
.
Since the variance of
becomes different to the gyroscope performance (
) in Equation (50), the yaw errors can be investigated for the gyroscopes in
Table 7 [
21,
22].
1
values of the heading error in Equation (39) is listed in
Table 8 for the accelerometer specifications in
Table 3 and gyroscope specifications in
Table 7 when
deg and
m as in section 3.4.
It can be seen from result in
Table 8 that the heading error is determined by the grade of the gyroscope. This is the same result as that of the generic INS gyro-compassing [
1,
4]. Therefore, the initial heading can be determined after the leveling is completed when gyroscopes are additionally located at the roll and pitch axes.
5. Concluding Remarks
In this paper, feasibility of obtaining initial attitude of the GF-INS has been investigated by deriving equations to obtain initial attitude from accelerometer outputs and calculating error of the initial attitude. Initial roll and pitch have been obtained as the generic INS after neglecting the very small centripetal acceleration. Initial heading has been expressed in terms of accelerometer outputs and its error has been derived. It has been checked that it is possible to calculate initial heading in the two configurations among 15 configurations proposed in other researches. However, it has been seen that it is not feasible to get initial heading when accelerometer error is considered.
When gyroscopes are additionally located into one or two axes, the initial heading have been expressed in accelerometer and gyroscope outputs and the feasibility of obtaining initial heading has been examined by investigating the heading error. As a result of this, it can be seen that the initial heading is obtained when gyroscopes are additionally located at the roll and pitch axes as the generic INS.
Author Contributions
Conceptualization, S. H. Oh and D.-H. Hwang; methodology, S. H. Oh and D.-H. Hwang; software, H. Kim; validation, H. Kim and J. H. Son; writing—original draft preparation, H. Kim; writing—review and editing, D. H. Hwang; supervision, D. H. Hwang; All authors have read and agreed to the published version of the manuscript.
Funding
This work was supported by the National Research Foundation of Korea (NRF) grant funded by the Korea government (MSIT). (No.2019R1A2C1088134).
Conflicts of Interest
The authors declare no conflict of interest.
References
- Titterton D., H.; Weston, J. L. , Strapdown inertial navigation technology,, 2nd ed.; The Institution of Electrical Engineers: Piscataway, New Jersey, US, 2004; pp. 17–301. [Google Scholar]
- Groves P. D., Principles of GNSS, Inertial, and Multi sensor Integrated Navigation Systems, 2nd ed., Artech House: England, 2013; pp. 15-160.
- Pitman G. R., Inertial Guidance, John Wiley & Sons Inc: New York, Hoboken, US, 1962; pp. 47-206.
- Bar-Itzhack I. Y.; Berman N. Control Theoretic Approach to Inertial Navigation Systems. AIAA Journal of Guidance, Control, and Dynamics 1998, 11, 237–245. [Google Scholar]
- Britting K. R., Inertial Navigation Systems Analysis, John Wiley & Sons Inc: New York, Hoboken, US, 1971; pp. 153-209.
- Schuler A. R.; Grammatikos A.; Fegley K. A. Measuring Rotational Motion with Linear Accelerometers. IEEE Transactions on Aerospace and Electronic Systems 1967, AES-3, 465–472. [Google Scholar] [CrossRef]
- Nusbaum, U.; Klein, I. Control Theoretic Approach to Gyro-Free Inertial Navigation Systems. IEEE Aerospace and Electronic Systems Magazine 2017, 32, 168–170. [Google Scholar] [CrossRef]
- Pachter, M.; Welker, T.C.; Huffman, R.E. Gyro free INS theory. Journal of the Institute of Navigation 2013, 60, 85–96. [Google Scholar] [CrossRef]
- Vaknin, E.; Klein, I. Coarse leveling of gyro-free INS. Journal of Gyroscopy and Navigation 2016, 7, 145–151. [Google Scholar] [CrossRef]
- Padgaonkar A. J.; Krieger K, W.; A.I. King. Measurement of Angular Acceleration of a Rigid Body Using Linear Accelerometers. Journal of Applied Mechanics 1975, 42, 552–556. [Google Scholar] [CrossRef]
- Park, S.; Tan, C.W.; Park, S. A scheme for improving the performance of a gyroscope-free inertial measurement unit. Sensors and Actuators A: Physical 2005, 121, 410–420. [Google Scholar] [CrossRef]
- Fangjun Q.; Xu J.; Sai J., A New Scheme of Gyroscope Free Inertial Navigation System Using 9 Accelerometers, 2009 International Workshop on Intelligent Systems and Applications, Wuhan, China, 23-24 May 2009.
- Shi Z.; Cheng Z.; Yang J., Study of Independent Initial Alignment Based on Gyroscope Free Strapdown Inertial Navigation System, 2010 Chinese Control and Decision Conference, Xuzhou, China, 26-28 May 2010, 2198-2202.
- Edwan, E.; Knedlik, S.; Loffeld, O. Constrained Angular Motion Estimation in a Gyro-Free IMU. IEEE Transactions on Aerospace and Electronic systems 2011, 47, 596–610. [Google Scholar] [CrossRef]
- Wang, X.; Xiao, L. Gyroscope-reduced inertial navigation system for flight vehicle motion estimation. Advances in Space Research 2017, 59, 413–424. [Google Scholar] [CrossRef]
- Farrell J. A., Aided Navigation – GPS with High Rate Sensors, McGrawHill, New York, US, 2008; pp. 416-421.
- Noureldin A.; Karamat T. B.; Georgy J. Fundamentals of Inertial Navigation Satellite-based Positioning and their Integration, Springer, New York, US, 2013; pp. 163-166.
- Kayton, M.; Fried W. R. Avionics Navigation Systems, 2nd Ed., John Wiley & Sons Inc: New York, US, 1997, pp. 382-386.
- Honeywell, Q-FLEX QA-2000 ACCELEROMETER – The inertial navigation standard, Honeywell International, Inc. Defense and Space Electronic Systems Redmond: Redmond, US, 2020.
- Muquans, Absolute Quantum Gravimeter – A free-fall absolute gravimeter based on laser-cooled atoms, Muquans: Rue François Mitterrand, France, 2022.
- Honeywell, HG1700 INERTIAL MEASUREMENT UNIT – Proven technology for a wide range of guidance and control applications, Honeywell Aerospace: Minneapolis, US, 2022.
- Honeywell, GG1320AN Digital Laser Gyro – Affordable and advanced sensing technology combined with unmatched production capabilities to meet the needs of customers throughout the world, Honeywell Aerospace: North America, US, 2015.
|
Disclaimer/Publisher’s Note: The statements, opinions and data contained in all publications are solely those of the individual author(s) and contributor(s) and not of MDPI and/or the editor(s). MDPI and/or the editor(s) disclaim responsibility for any injury to people or property resulting from any ideas, methods, instructions or products referred to in the content. |
© 2023 by the authors. Licensee MDPI, Basel, Switzerland. This article is an open access article distributed under the terms and conditions of the Creative Commons Attribution (CC BY) license (http://creativecommons.org/licenses/by/4.0/).