Next Article in Journal
Joint Design of Space-Time Transmit and Receive Weights for Colocated MIMO Radar
Previous Article in Journal
Sensitivity-Based Fault Detection and Isolation Algorithm for Road Vehicle Chassis Sensors
 
 
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

IMU Signal Generator Based on Dual Quaternion Interpolation for Integration Simulation

1
College of Artificial Intelligence, National University of Defense Technology, Changsha 410073, China
2
College of Systems Engineering, National University of Defense Technology, Changsha 410073, China
*
Author to whom correspondence should be addressed.
Submission received: 16 July 2018 / Revised: 14 August 2018 / Accepted: 15 August 2018 / Published: 18 August 2018
(This article belongs to the Section Physical Sensors)

Abstract

:
This paper focuses on the problem of high-update-rate and high accuracy inertial measurement unit signal generation. In order to be in accordance with the vehicle’s kinematic and dynamic characteristics as well as the characteristics of pseudorange of post-processed global navigation satellite system and their rate measurements, a novel dual quaternion interpolation and analytic integration algorithm based on actual flight data is proposed. The proposed method can simplify the piecewise analytical expressions of angular rates, angular increments and specific force integral increments. Norm corrections are adopted as constraint conditions to guarantee the accuracy of the signals. Numerical simulations are conducted to validate the method’s performance.

1. Introduction

Inertial measurement unit (IMU) signal generators have been used in numerous engineering fields for algorithm testing and verification to reduce experimental costs and shorten developing time under laboratory conditions. It can be used in industrial robots for motion control [1,2,3], path planning of unmanned aerial vehicles (UAV) [4], tightly coupled integrated navigation research [5,6,7] and guidance system simulation [8]. A Global Navigation Satellite System (GNSS) signal simulator is required to generate multiple synchronous signals, one for each satellite in view, and to generate consistent navigation data for the receiver to be able to compute the position. Moreover, a corresponding IMU signal simulator is also necessary to provide gyro and accelerometer measurements for the strapdown inertial navigation system (SINS) and GNSS integration research.
The followings are required for a IMU signal generator to be used in the tightly coupled SINS/GNSS integration simulation:
(1)
GNSS’s pseudorange and their rate measurements corresponding to the simulated navigation parameters such as position and velocity as well as satellite ephemeris are required.
(2)
The simulated gyro measurements and accelerometer measurements in the trajectory are coincident with the vehicle’s kinematic and dynamic characteristics.
(3)
The IMU size effects as well as the level arm effects caused by the displacements of the GNSS receiver antenna from the IMU reference point can be simulated. For this purpose, the analytic angular rate and the angular acceleration data are required.
(4)
Various SINS algorithms and update rates can be evaluated under the dynamic environment in trajectories through simulations.
In this paper, an actual-flight-data based IMU signal generation algorithm is presented. Actual GNSS navigation data files (including satellite ephemeris) and observation data files (including GNSS’s pseudorange and their rate measurements) can be obtained through practical flight experiments. The post-processed GNSS navigation solution and a low-cost loosely coupled SINS/GNSS integrated navigation system provide position, velocity and attitude parameters at discrete time intervals (1 Hz). The spline interpolation method is used to generate analytic continuous-time kinematic simulation trajectory. The main contributions of this paper can be summarized as follows: (1) A novel IMU signal generation algorithm is proposed based on dual quaternions and actual flight data. (2) The effectiveness and efficiency of the proposed algorithm are validated by extensive simulation experiments. (3) Compared with state-of-the-art methods, the proposed method generates signals with the highest accuracy in a relatively short computation time.
This paper is organized as follows. Section 2 introduces the related works about the IMU signal generator and dual quaternions. Section 3 provides a dual quaternion representation of angular increments and specific force integral increments for IMU measurements simulation. Section 4 provides two-point piecewise cubic spline interpolation, analytic integration, norm corrections and error analysis of interpolated dual quaternions. Simulation tests for analytic IMU signal generator validation are presented in Section 5. Conclusions are drawn in Section 6.

2. Related Works

For the IMU signal generator, over the decades, various approaches have been developed, which can be classified into three general categories: pure mathematical models [9,10,11,12,13], kinematic or dynamic models [14,15,16,17] and actual flight-data based methods [18,19].
The methods based on pure mathematical models mainly depend on the vehicle’s straightforward manoeuvre, such as climbing up, straight flight, turning flight and diving. Moreover, the integration of these manoeuvres can be simulated. Two types of highly straightforward models are commonly used. The first one is the linear acceleration that has phase step with 50 g, wherein the acceleration is a constant. The other one is the circular motion or turn that has radial acceleration with 50 g; furthermore, all the velocities and derivations follow the sinusoidal waveform. Although the form is adopted, all of them are highly straightforward. A trajectory generated by these methods can neither reflect the complex kinematics and dynamics of a vehicle nor be conducive to combining with actual flight experiments to produce consistent simulation trajectory using satellite signals and multi-sensor measurement data such as those from image sensors. In kinematic and dynamic model based methods, classical kinematic or dynamic equations are used to generate inertial sensor measurements under flight simulation conditions, and the impact of the pneumatic environment of a vehicle can also be considered. The drawback is that it is generally challenging to predetermine the position and attitude of the vehicle precisely in the simulated trajectory. In addition, physical and mathematical models are often excessively complex to be described, and the degree of approximation between the generated trajectory and the vehicle’s actual motion depends on the accuracy of the kinematic models. Based on actual flight data, the incremental outputs of the inertial sensors are inversely deduced from the attitude, velocity and positioning information using a numerical strapdown inertial navigation system (SINS) attitude and velocity updating algorithm, which can be referred to as an inverse SINS algorithm. Generally, this algorithm requires high update rate of data of navigational parameters (100 Hz–1000 Hz). Because the inverse SINS algorithm is used, the accuracy influences of the strapdown inertial navigation algorithm and update rates are not considered. It is not feasible to simulate error factors such as size effects and lever arm effects because of the lack of the angular rate and the angular acceleration data in numerical simulations using the inversed SINS algorithm.
Dual quaternions (DQ) can provide a uniform representation of the rotational and translational motion of a rigid body in space. It was proposed by Clifford in 1873 and based on the dual quaternion algebra to describe the spiral variation. In 1992, dual quaternion was first used in the inertial navigation field by Branets and Shmyglevsky [20]. They analysed its feasibility and drew the outline of various coordinates’ relationships in SINS. In 2004, Y.X Wu elaborated upon strapdown inertial navigation system algorithms based on the dual quaternion and demonstrated the consistency of the differential equations between dual quaternion algorithms and traditional algorithms [21]. Compared with the general methods, the superior accuracy performance of the dual quaternion has been proved [21,22]. In [21], the author analysed the algorithm errors and proved that the algorithm based on DQ was superior to conventional ones in terms of the accuracy of the translational components (velocity vectors and position vectors) from both the analytic forms and the numerical simulation perspectives. Moreover, it was indicated that the new algorithm was a better choice than all conventional algorithms for applications in high-accuracy navigation systems and high-manoeuvre applications. In [22], the accuracy advantage of the algorithm based on DQ was analysed, and the analytic comparisons indicated that the thrust velocity solution as well as the attitude and gravitational velocity solution were superior to the traditional navigation algorithms in terms of accuracy.
In this study, a novel dual quaternion interpolation and analytic integration algorithm is used to generate high update rate and high accuracy IMU signals for actual-flight-data based integrated navigation simulation, in which the piecewise analytical expressions of angular increments and specific force integral increments in the body frame are simplified. A method to solve the norm constraint problems in quaternion and dual quaternion interpolation is presented.

3. Dual Quaternion Representation of Angular Increments and Specific Force Integral Increments

In this section, the relationship between dual quaternion and angular rates in the body frame and that between dual quaternion and specific force in the body frame are presented for ease of reference and for providing the foundation for the dual quaternion interpolation.

3.1. Rotation and Translation Expressed as a Dual Quaternion

Rotation and translation between the inertial frame (i frame) and the body frame (b frame) can be expressed as a dual quaternion in the following manner [21]
q = q + ε p = q + ε 1 2 t i q = q + ε 1 2 q t b
where, q = q + ε p is the dual quaternion, and ε2 = 0. The real part q is the general quaternion to facilitate the representation of rotation, p is the dual part of q , and represents the quaternion or dual quaternion multiplication. The translation component t can be defined as (see Appendix A for details)
t b = q * v i b i 0 t g i b i d t q t i = v i b i 0 t g i b i d t
where, v i b c is the velocity vector of frame b relative to frame i expressed in frame c, g i b c is the gravitational acceleration vector expressed in frame c.
The rotational and translational kinematics can be expressed as a differential equation of the dual quaternion as
q ˙ = 1 2 q ω i b b
in which
ω i b b = ω i b b + ε ( t ˙ b + ω i b b + t b )
where, ω i b b is a dual vector and generally referred to as twist, × represents the vector product, and ωc1c2 represents the angular rate vector of frame c2 relative to frame c1.
Using 2 q ˙ = ω i b i q = q ω i b b and the fact that q q * = 1 , where * represents the conjugate operator, the following is obtained:
t ˙ b + ω i b b × t b = q * v ˙ i b i g i b i q + q ˙ * v i b i 0 t g i b i d t q + q * v i b i 0 t g i b i d t q ˙ + ω i b b × t b = q * a i b i g i b i q q * q ˙ q * v i b i 0 t g i b i d t q + q * v i b i 0 t g i b i d t q ˙ + ω i b b × t b = q * a i b i g i b i q + q * t i × ω i b i q + ω i b b × t b = q * f i b i q = f i b b
where f i b c is the specific force vector expressed in frame c, a i b c is the acceleration vector of frame b relative to frame i expressed in frame c.
Substituting Equation (5) in Equation (4), we obtain
ω i b b = ω i b b + ε f i b b
where the twist is a combination of the angular velocity and the specific force in frame b.
Substituting Equation (6) in Equation (3), the twist is obtained as follows:
ω i b b = 2 q * q ˙ = ω i b b + ε f i b b = 2 ( q + ε p ) * ( q ˙ + ε p ˙ ) = 2 q * q ˙ + ε 2 ( q * p ˙ + p * q ˙ )

3.2. Integral Increments of Angular Rates and Specific Force in Body Frame

Integrating Equation (7) over the sampling time interval t k Δ T , t k , the angular rate increments Δ θ t k and the specific force integral increments Δ υ t k at time t k can be expressed as
Δ θ t k = t k Δ T t k ω i b b t d t = t k Δ T t k 2 q * t q ˙ t d t = 2 t k Δ T t k q ˙ * t q t d t
Δ υ t k = t k Δ T t k f i b b t d t = 2 t k Δ T t k q * t p ˙ t + p * t q ˙ t d t = 2 q * t p t t k Δ T t k 2 t k Δ T t k q ˙ * t p t d t + 2 t k Δ T t k p * t q ˙ t d t = 2 q * t p t t k Δ T t k 4 t k Δ T t k q ˙ * t p t d t
where
q * t q ˙ t = q * t q ˙ t * = q ˙ * t q t p * t q ˙ t = p * t q ˙ t * = q ˙ * t p t
considering q * t q ˙ t and p * t q ˙ t are quaternions with zero scalar parts.

4. Piecewise Constraint Interpolation and Analytic Integration Algorithm

In this section, a novel IMU signal generation algorithm is developed based on the dual quaternion interpolation, which is suitable for implementation in navigation fields. The two-point piecewise cubic spline interpolation and the analytic integration are used for the dual quaternion, and angular increments and specific force increments can be obtained. Additionally, the error analysis and methods for accuracy enhancement are also presented.
An algorithm flow chart is illustrated in Figure 1 that provides the detailed steps to streamline the algorithm proposed in this paper. The proposed method provides a necessary basis for the offline test of the performance of SINS and its fusion with other sensors’ signals to verify the performance of the integrated navigation algorithm. By using this algorithm, we can get IMU signal data with any frequency. If the sensor (IMU) outputs and all the flight data can be collected, the proposed algorithm is not necessary.
The algorithm can be divided into the following three parts:
  • Attitude Part
    (1)
    Convert Euler angles (roll, pitch and yaw) from the navigation frame n to quaternion in frame i.
    (2)
    Set the interpolation interval T i n t e r p . The cubic spline interpolation is adopted for the quaternion. Combined with the constraint conditions, the discrete quaternion q and its derivative are obtained.
    (3)
    Using 0 , T as the new interpolation interval, the polynomial of q t are obtained.
    (4)
    Calculate the angular rate and its integral increments.
    (5)
    Use average approximation to modify the values of angular increments.
  • Position Part
    (1)
    Convert the position information (latitude, longitude and altitude) from the navigation frame n to the inertial frame i.
    (2)
    Set the interpolation interval T i n t e r p . The cubic spline interpolation is adopted for the position and velocity. Then, the discrete velocity values can be obtained.
    (3)
    Gravity values in the Earth-centered inertial (ECI) coordinates are calculated according to the gravity formula.
    (4)
    Set the interpolation interval T i n t e r p . The cubic spline interpolation is adopted for the gravity values. Then, discrete gravity integral values can also be obtained.
    (5)
    Using the discrete quaternion and its derivative, discrete velocity values and its derivative, discrete gravity and its integral values, discrete p and its derivative can be obtained.
    (6)
    Using 0 , T as the new interpolation interval, the polynomials of p t are obtained.
    (7)
    Combined with the polynomials of q t , the specific force and its integral increments are obtained.
    (8)
    Use average approximation to modify the values of specific force integral increments.
  • Solution Part
Based on the two sub-sample error compensation algorithms, the inertial sensor simulated samples Δ υ and Δ θ are used to update pure SINS. The attitude and the position results are compared with the actual flight data input.
In this algorithm, two sample time intervals are involved. The first one is the interpolation time interval, which is the interval between the interpolation points selected from the original input data. The second one is the integration time interval, which is the interval for the integration of angular rate and specific force.

4.1. Dual Quaternion Calculation at Discrete Time Based on Actual Flight Data

The actual flight data including navigational parameters such as position r i b i , velocity v i b i and quaternion q at discrete time t m can be obtained through a SINS/GNSS loosely integrated navigation system in a UAV.
The dual quaternion and its derivative at discrete time t m can be calculated based on the following equations:
q ( t m ) = q ( t m ) + ε p ( t m ) = q ( t m ) + ε 1 2 v i b i ( t m ) t 0 t m g i b i d t q ( t m )
q ˙ ( t m ) = q ˙ ( t m ) + ε p ˙ ( t m ) = q ˙ ( t m ) + ε 1 2 v i b i ( t m ) t 0 t m g i b i d t q ˙ ( t m ) + ε 1 2 v ˙ i b i ( t m ) g i b i q ( t m )
where, g i b i is the function of r i b i . The gravitation integration is calculated as follows:
t 0 t m g i b i d t = t 0 t m g i b i r i b i ( t ) d t = j = 1 m t j 1 t j g i b i r i b i ( t ) d t
r i b i ( t ) can be obtained by the piecewise cubic spline interpolation in the time period t j 1 , t j , T j = t j t j 1 .
r i b i ( t ) = T j 2 v i b i ( t j ) + v i b i ( t j 1 ) 2 T j 3 r i b i ( t j ) r i b i ( t j 1 ) ( t t j 1 ) 3 + 3 T j 2 r i b i ( t j ) r i b i ( t j 1 ) T j 1 v i b i ( t j ) + v i b i ( t j 1 ) ( t t j 1 ) 2 + v i b i ( t j 1 ) ( t t j 1 ) + r i b i ( t j 1 )
Differentiate Equation (14) twice, and let j = m , t = t m and T m = t m t m 1 . v ˙ i b i ( t m ) in Equation (12) can be calculated as
v ˙ i b i ( t m ) = 6 T m 2 v i b i ( t m ) + v i b i ( t m 1 ) 2 T m 3 r i b i ( t m ) r i b i ( t m 1 ) ( t t m 1 ) + 2 3 T m 2 r i b i ( t m ) r i b i ( t m 1 ) T m 1 v i b i ( t m ) + v i b i ( t m 1 )
q ˙ ( t m ) in Equation (12) can be obtained by the interpolation.
The piecewise cubic spline interpolation for the quaternion is expressed by [23]
q ¯ ( t ) = a ¯ m t 3 + b ¯ m t 2 + c ¯ m t + d ¯ m , t t m 1 , t m , m 1 , 2 , 3 , M
q ¯ ˙ ( t ) = 3 a ¯ m t 2 + 2 b ¯ m t + c ¯ m , t t m 1 , t m , m 1 , 2 , 3 , M
where a ¯ m , b ¯ m , c ¯ m , d ¯ m are the coefficients of the polynomial, and they vary across the interpolation intervals. The subscript m (or m 1 in the following content) represents the time point.
q ¯ t m represents the piecewise cubic spline quaternion in the time interval t t m 1 , t m
q ¯ ( t m ) = a ¯ m t m 3 + b ¯ m t m 2 + c ¯ m t m + d ¯ m = a ¯ m 1 t m 3 + b ¯ m 1 t m 2 + c ¯ m 1 t m + d ¯ m 1
q ¯ ˙ ( t m ) = 3 a ¯ m t m 2 + 2 b ¯ m t m + c ¯ m = 3 a ¯ m 1 t m 2 + 2 b ¯ m 1 t m + c ¯ m 1
q ¯ ¨ ( t m ) = 6 a ¯ m t m + 2 b ¯ m = 6 a ¯ m 1 t m + 2 b ¯ m 1
Considering the constraint condition q t = 1 , the quaternion interpolation and its derivatives can be rectified as follows:
q t = q ¯ t q ¯ t
q ˙ t = d d t q ¯ t q ¯ t = q ¯ ˙ t · q ¯ t q ¯ t · d d t q ¯ t q ¯ t 2
where,
d d t q ¯ t = q ¯ 0 t q ¯ ˙ 0 t + q ¯ 1 t q ¯ ˙ 1 t + q ¯ 2 t q ¯ ˙ 2 t + q ¯ 3 t q ¯ ˙ 3 t q ¯ t
Let t = t m , considering q ¯ t m = q t m = 1
q ˙ ( t m ) = q ¯ ˙ ( t m ) · q ¯ ( t m ) q ¯ ( t m ) · q ¯ 0 ( t m ) q ¯ ˙ 0 ( t m ) + q ¯ 1 ( t m ) q ¯ ˙ 1 ( t m ) + q ¯ 2 ( t m ) q ¯ ˙ 2 ( t m ) + q ¯ 3 ( t m ) q ¯ ˙ 3 ( t m ) / q ¯ ( t m ) q ¯ ( t m ) 2 = q ¯ ˙ ( t m ) q ¯ ( t m ) · q ¯ 0 ( t m ) q ¯ ˙ 0 ( t m ) + q ¯ 1 ( t m ) q ¯ ˙ 1 ( t m ) + q ¯ 2 ( t m ) q ¯ ˙ 2 ( t m ) + q ¯ 3 ( t m ) q ¯ ˙ 3 ( t m )
where q 0 , q 1 , q 2 , q 3 are the four elements of the quaternion, and q ˙ 0 , q ˙ 1 , q ˙ 2 , q ˙ 3 are the derivatives of the four elements of quaternion.

4.2. Two-Point Piecewise Cubic Spline Interpolation for Dual Quaternions

In order to obtain the analytic integrations of Equations (8) and (9), the cubic spline interpolation for the dual quaternion is expressed by
q ˜ ( t ) = q ˜ ( t m 1 + τ ) = q ( t m 1 + τ ) + ε p ( t m 1 + τ ) = a ( t m ) τ 3 + b ( t m ) τ 2 + q ˙ ( t m ) τ + q ( t m ) + ε [ c ( t m ) τ 3 + d ( t m ) τ 2 + p ˙ ( t m ) τ + p ( t m ) ]
q ˜ ˙ ( t ) = q ˜ ˙ ( t m 1 + τ ) = q ˜ ˙ ( t m 1 + τ ) + ε p ˜ ˙ ( t m 1 + τ ) = 3 a ( t m ) τ 3 + 2 b ( t m ) τ + q ˙ ( t m ) + ε 3 c ( t m ) τ 2 + 2 d ( t m ) τ + p ˙ ( t m )
where, T m = t m t m 1 , τ 0 , T m
a ( t m ) = 2 T m 3 q ( t m 1 ) q ( t m ) + T m 2 q ˙ ( t m 1 ) + q ˙ ( t m )
b ( t m ) = 3 T m 2 q ( t m 1 ) q ( t m ) T m 1 q ˙ ( t m 1 ) + q ˙ ( t m )
c ( t m ) = 2 T m 3 p ( t m 1 ) p ( t m ) + T m 2 p ˙ ( t m 1 ) + p ˙ ( t m )
d ( t m ) = 3 T m 2 p ( t m 1 ) p ( t m ) T m 1 p ˙ ( t m 1 ) + p ˙ ( t m )
subject to the following constraints of two-point boundary conditions
q ˜ ( t m ) = q ˜ ( t m ) + ε p ˜ ( t m ) = q ( t m ) + ε p ( t m ) q ˜ ( t m 1 ) = q ˜ ( t m 1 ) + ε p ˜ ( t m 1 ) = q ( t m 1 ) + ε p ( t m 1 )
q ˜ ˙ ( t m ) = q ˜ ˙ ( t m ) + ε p ˜ ˙ ( t m ) = q ˙ ( t m ) + ε p ˙ ( t m ) q ˜ ˙ ( t m 1 ) = q ˜ ˙ ( t m 1 ) + ε p ˜ ˙ ( t m 1 ) = q ˙ ( t m 1 ) + ε p ˙ ( t m 1 )
q ˜ is the dual quaternion interpolation in the time interval τ ∈ [0, Tm] without normalization, q ˜ is the quaternion interpolation in the time interval τ ∈ [0, Tm] without normalization, and p ˜ is the dual part interpolation of q ˜ in the time interval τ ∈ [0, Tm].

4.3. Analytic Integration of Dual Quaternions

The twist, which is defined in the dual quaternion interpolations, is expressed by
ω ˜ i b b = 2 q ˜ * q ˜ ˙ = ω ˜ i b b + ε f ˜ i b b = 2 ( q ˜ + ε p ˜ ) * ( q ˜ ˙ + ε p ˜ ˙ ) = 2 q ˜ * q ˜ ˙ + ε 2 ( q ˜ * + p ˜ ˙ + p ˜ * q ˜ ˙ )
By substituting Equations (24) and (25) into Equation (32), integrating Equation (32) over the sampling time interval t k Δ T , t k and supposing t k = t m 1 + τ l , the following equations can be determined. 1 / Δ T represents the integration frequency.
Δ θ ˜ t k = t k Δ T t k ω ˜ i b b t d t = 2 t k Δ T t k q ˜ * t q ˜ ˙ t d t = 2 τ l Δ T τ l q ˜ * t m 1 + τ q ˜ ˙ t m 1 + τ d τ = a ˜ * ( t m ) a ˜ ( t m ) τ 6 τ l Δ T τ l 6 5 a * ( t m ) b ( t m ) + 4 5 b * ( t m ) a ( t m ) τ 5 τ l Δ T τ l 3 2 a * ( t m ) q ˙ ( t m ) + b * ( t m ) b ( t m ) + 1 2 q ˙ * ( t m ) a ( t m ) τ 4 τ l Δ T τ l 2 a * ( t m ) q ( t m ) + 4 3 b * ( t m ) q ˙ ( t m ) + 2 3 q ˙ * ( t m ) b ( t m ) τ 3 τ l Δ T τ l 2 b * ( t m ) q ( t m ) + q ˙ * ( t m ) q ˙ ( t m ) τ 2 τ l Δ T τ l 2 q ˙ * ( t m ) q ( t m ) τ τ l Δ T τ l
Δ υ ˜ t k = t k Δ T t k f ˜ i b b t d t = 2 q ˜ * t p ˜ t t k Δ T t k 4 t k Δ T t k q ˜ ˙ * t p ˜ t d t = 2 q ˜ * t m 1 + τ p ˜ t m 1 + τ τ l Δ T τ l 4 τ l Δ T τ l q ˜ ˙ * t m 1 + τ p ˜ t m 1 + τ d τ = 2 a * ( t m ) c ( t m ) τ 6 τ l Δ T τ l + 2 a * ( t m ) d ( t m ) + 2 b * ( t m ) c ( t m ) τ 5 τ l Δ T τ l + 2 a * ( t m ) p ˙ ( t m ) + 2 b * ( t m ) d ( t m ) + 2 q ˙ * ( t m ) c ( t m ) τ 4 τ l Δ T τ l + 2 a * ( t m ) p ( t m ) + 2 b * ( t m ) p ˙ ( t m ) + 2 q ˙ * ( t m ) d ( t m ) + 2 q * ( t m ) c ( t m ) τ 3 τ l Δ T τ l + 2 b * ( t m ) p ( t m ) + 2 q ˙ * ( t m ) p ˙ ( t m ) + 2 q * ( t m ) d ( t m ) τ 2 τ l Δ T τ l + 2 q ˙ * ( t m ) p ( t m ) + 2 q * ( t m ) p ˙ ( t m ) τ τ l Δ T τ l + 2 q * ( t m ) p ( t m ) 2 a * ( t m ) c ( t m ) τ 6 τ l Δ T τ l 12 5 a * ( t m ) d ( t m ) + 8 5 b * ( t m ) c ( t m ) τ 5 τ l Δ T τ l 3 a * ( t m ) p ˙ ( t m ) + 2 b * ( t m ) d ( t m ) + q ˙ * ( t m ) c ( t m ) τ 4 τ l Δ T τ l 4 a * ( t m ) p ( t m ) + 8 3 b * ( t m ) p ˙ ( t m ) + 4 3 q ˙ * ( t m ) d ( t m ) τ 3 τ l Δ T τ l 4 b * ( t m ) p ( t m ) + 2 q ˙ * ( t m ) p ˙ ( t m ) τ 2 τ l Δ T τ l 4 q ˙ * ( t m ) p ( t m ) τ τ l Δ T τ l

4.4. Norm Corrections of Dual Quaternion

The norm of the dual quaternion representing rotation and translation between the inertial frame and the body frame is defined as
q 2 = q q * = ( q + ε p ) ( q + ε p ) * = ( q + ε p ) ( q * + ε p * ) = q q * + ε ( q p * + p q * ) = q q * + ε ( q ( 1 2 t i q ) * + ( 1 2 t i q ) q * ) = 1 + ε ( q q * ( 1 2 t i ) + t i q q * ) = 1
in which, q q * = q 0 2 + q 1 2 + q 2 2 + q 3 2 = 1 , q p * + p q * = 2 q 0 p 0 + q 1 p 1 + q 2 p 2 + q 3 p 3 = 0 and q 2 is the square of the dual quaternion norm. Generally, the cubic spline interpolation q ˜ t and p ˜ t do not satisfy these constraints, which results in undesirable fluctuation errors in Δ θ ˜ t k and Δ υ ˜ t k .
To solve these problems, norm corrections of the dual quaternion interpolation is brought into the analytic integrations as follows:
q = q ˜ / q ˜
q ˙ = q ˜ ˙ q ˜ q ˜ q ˜ ˙ / q ˜ 2
Substituting Equation (36) into Equation (7), the corrected twist is derived as
ω i b b = ω i b b + ε f i b b = 2 q ˜ * q ˜ q ˜ ˙ q ˜ q ˜ d d t q ˜ q ˜ 2 = 2 q ˜ * q ˜ ˙ q ˜ 2 2 d d t q ˜ q ˜ = ω ˜ i b b q ˜ 2 2 d d t q ˜ q ˜ = ω ˜ i b b + ε f ˜ i b b q ˜ 2 2 d d t q ˜ q ˜
where
1 q ˜ 2 = 1 q ˜ + ε p ˜ q ˜ + ε p ˜ * = 1 q ˜ q ˜ * + ε q ˜ p ˜ * + p ˜ q ˜ * = 1 q ˜ 2 + ε q ˜ p ˜ * + p ˜ q ˜ * · q ˜ 2 ε q ˜ p ˜ * + p ˜ q ˜ * q ˜ 2 ε q ˜ p ˜ * + p ˜ q ˜ * = q ˜ 2 ε q ˜ p ˜ * + p ˜ q ˜ * q ˜ 4 = 1 q ˜ 2 2 ε q ˜ 0 p ˜ 0 + q ˜ 1 p ˜ 1 + q ˜ 2 p ˜ 2 + q ˜ 3 p ˜ 3 q ˜ 4
Substituting Equation (38) into Equation (37), the angular rates and specific force can be expressed as
ω i b b + ε f i b b = ω ˜ i b b q ˜ 2 + ε f ˜ i b b q ˜ 2 2 q ˜ 0 p ˜ 0 + q ˜ 1 p ˜ 1 + q ˜ 2 p ˜ 2 + q ˜ 3 p ˜ 3 ω ˜ i b b q ˜ 4 2 d d t q ˜ q ˜
2 d d t q ˜ q ˜ is scalar and can be neglected in the vector computation for ω i b b and f i b b .
Considering the fact that sampling time Δ T is generally marginal (5 ms or less) over the sampling time interval t k Δ T , t k , the following approximations can be adopted:
1 q ˜ 2 2 q ˜ t k Δ T 2 + q ˜ t k 2
2 q ˜ 0 p ˜ 0 + q ˜ 1 p ˜ 1 + q ˜ 2 p ˜ 2 + q ˜ 3 p ˜ 3 q ˜ 4 A t k q ˜ 0 t k Δ T p ˜ 0 t k Δ T + q ˜ 1 t k Δ T p ˜ 1 t k Δ T q ˜ t k Δ T 4 + q ˜ 2 t k Δ T p ˜ 2 t k Δ T + q ˜ 3 t k Δ T p ˜ 3 t k Δ T q ˜ t k Δ T 4 + q ˜ 0 t k p ˜ 0 t k + q ˜ 1 t k p ˜ 1 t k + q ˜ 2 t k p ˜ 2 t k + q ˜ 3 t k p ˜ 3 t k q ˜ t k 4
Based on the above equations, the integral angular rate increments in Equation (8) and specific force integral increments in Equation (9) can be rewritten as
Δ θ t k = t k Δ T t k ω i b b t d t 2 q ˜ t k Δ T 2 + q ˜ t k 2 t k Δ T t k ω ˜ i b b t d t = 2 q ˜ t k Δ T 2 + q ˜ t k 2 · Δ θ ˜ t k
Δ υ t k = t k Δ T t k f i b b t d t 2 q ˜ t k Δ T 2 + q ˜ t k 2 t k Δ T t k f ˜ i b b t d t A t k t k Δ T t k ω ˜ i b b t d t = 2 q ˜ t k Δ T 2 + q ˜ t k 2 Δ υ ˜ t k A t k Δ θ ˜ t k
By this procedure, simulated IMU signals including gyro measurements and accelerometer measurements can be calculated by the dual quaternion interpolation and the analytic integration.
As ω i b b and ω ˙ i b b can be obtained analytically, the error sources such as the size effects and the lever arm effects can also be simulated [24]. For example, when r b x b , r b y b and r b z b (the displacements of the x-, y- and z- axis accelerometers, respectively, from the IMU reference point expressed in frame b ) are specified, the size effect caused by the displacements of the accelerometers from the IMU reference point can be simulated. Similarly, when r b a b (the displacement of the GNSS receiver antenna from the IMU reference point expressed in frame b ) is specified, the lever arm effect caused by the displacement of the GNSS receiver antenna from the IMU reference point can also be simulated.

4.5. Error Analysis and Methods for Accuracy Enhancement

The error caused by approximations in Equations (40) and (41) can be expressed as:
δ ω i b b = 1 q ˜ 2 2 q ˜ t k Δ T 2 + q ˜ t k 2 ω i b b
δ f i b b = 1 q ˜ 2 2 q ˜ t k Δ T 2 + q ˜ t k 2 f i b b 2 q ˜ 0 p ˜ 0 + q ˜ 1 p ˜ 1 + q ˜ 2 p ˜ 2 + q ˜ 3 p ˜ 3 q ˜ 4 A t k ω i b b
where A t k is defined in Equation (41), δ ω i b b is the error vector of the angular rate, and δ f i b b is the error vector of the specific force.
For a low dynamic vehicle trajectory, amplitudes of ω i b b and f i b b are generally negligible; therefore, errors in Equations (44) and (45) can be neglected. For a high dynamic vehicle trajectory with large angular rates and specific force, a smaller sampling integration time interval Δ T is to be selected to reduce the errors.
In terms of the computational complexity, this algorithm only needs a series of sequential calculations including interpolation, differentiation, multiplication and integration for each point. When there are n points, the number of calculation steps is proportional to n. Therefore, the computational complexity is O n .

5. Simulation Tests for Analytic IMU Signal Generator Performance Validation

This section describes the numerical simulations to validate the proposed algorithm. We choose the quaternion error and the position error as the test metrics to illustrate the performance of the algorithm. The quaternion error means the error between the quaternion of the original data we input and the quaternion of the results we obtained. The position error means the error between the position in ECI coordinates of the original data we input and the position in ECI coordinates of the results we obtained. The results of quaternion and the position in ECI coordinates are obtained by using the strapdown inertial navigation solution with the angular increment and the specific force increment obtained by the proposed algorithm.
The actual flight data including position, velocity, attitude and time as well as GNSS’s pseudoranges and their rate measurements have been procured from post-processed GNSS navigation solutions and a low-cost loosely coupled SINS/GNSS integrated navigation system in a UAV. The information of the attitude and the position are used for the algorithm proposed in this paper to generate the IMU signal. The update rate of flight data is 1 Hz and the total duration is 1200 s. The flight profile includes climbing, turning, cruise and a few flying manoeuvres, which are illustrated in Figure 2.
We choose 1 s as the analytic interpolation interval, i.e., T i n t e r p = T = 1, which is consistent with the sampling frequency of the satellite signals. The simulated angular rate integral increments and the specific force integral increments are generated based on the dual quaternion interpolations at a frequency of 400 Hz. That is to say, Δ T = 0.0025 s. It is a common sampling frequency of SINS in engineering. The strapdown inertial navigation simulation is performed to verify the accuracy of the simulated gyro and accelerometer measurements. The coning and sculling compensation algorithms are used for the attitude and velocity update, while the trapezoidal integration method is used for the position update [24]. The strapdown inertial navigation simulation results are compared with the flight trajectory at time t m without considering the initial alignment errors and instrument errors such as gyro drifts, accelerometer biases and scale factor errors. The attitude and position error comparisons of the simulation results are illustrated in Figure 3 and Figure 4, respectively.
It can be observed in Figure 3 and Figure 4 that the attitude quaternion error and position error accumulate over time, which is consistent with the inertial navigation’s error characteristics (the attitude error and the position error accumulate with time). In Figure 4, the fluctuation is mainly owing to the use of the average approximation and the computing error, and it can be neglected. The quaternion error is smaller than 9 . 66 × 1 0 11 , and the position error is smaller than 0.021 m. The simulated angular rate increments and specific force integral increments are highly satisfactory and show high accuracy because the errors in Figure 3 and Figure 4 are substantially smaller than those caused by misalignments or bias and scale factor errors of gyros and accelerometers.
In order to further illustrate the algorithm’s performance, the inverse SINS algorithm in [18] and the trajectory generation algorithm based on quaternion [19] are used with the same actual flight data. For the inverse SINS algorithm, the interpolation interval is also set as 1 s and the integrated frequency is 400 Hz. The attitude and position error comparisons of the simulation results are illustrated in Figure 5 and Figure 6, respectively.
According to the trajectory generation algorithm based on the quaternion [19], the following can be obtained:
ω i b b t = 2 q ¯ k t 2 q ¯ 1 , k t q ¯ 0 , k t q ¯ 3 , k t q ¯ 2 , k t q ¯ 2 , k t q ¯ 3 , k t q ¯ 0 , k t q ¯ 1 , k t q ¯ 3 , k t q ¯ 2 , k t q ¯ 1 , k t q ¯ 0 , k t q ¯ ˙ 0 , k t q ¯ ˙ 1 , k t q ¯ ˙ 2 , k t q ¯ ˙ 3 , k t
f i b , k b t = a i b , k b t g i b , k b t = C i , k b t a i b , k i t C i , k b t g i b , k i t = 1 q ¯ k t 2 c ¯ 11 , k t c ¯ 21 , k t c ¯ 31 , k t c ¯ 12 , k t c ¯ 22 , k t c ¯ 32 , k t c ¯ 13 , k t c ¯ 23 , k t c ¯ 33 , k t a i b , k i t g i b , k i t
where c ¯ i j , k t is the function of quaternion q ¯ k t . Using the first-order Taylor expansion for 1 / q ¯ k t 2 , Equations (46) and (47) can be rewritten as
ω i b b t = 2 q ¯ k t 2 q ¯ 1 , k t q ¯ 0 , k t q ¯ 3 , k t q ¯ 2 , k t q ¯ 2 , k t q ¯ 3 , k t q ¯ 0 , k t q ¯ 1 , k t q ¯ 3 , k t q ¯ 2 , k t q ¯ 1 , k t q ¯ 0 , k t q ¯ ˙ 0 , k t q ¯ ˙ 1 , k t q ¯ ˙ 2 , k t q ¯ ˙ 3 , k t
f i b , k b t = 2 q ¯ k t 2 c ¯ 11 , k t c ¯ 21 , k t c ¯ 31 , k t c ¯ 12 , k t c ¯ 22 , k t c ¯ 32 , k t c ¯ 13 , k t c ¯ 23 , k t c ¯ 33 , k t a i b , k i t g i b , k i t
With the same actual flight data, the error result can be obtained by MATLAB simulation. The attitude and the position errors are illustrated in Figure 7 and Figure 8, respectively.
In the strapdown inertial navigation system, the attitude accuracy is highly critical for the whole system’s calculation. Through the simulation, it can be observed that the dual quaternion interpolation algorithm developed in this study shows the highest attitude accuracy, with an error of 9 . 660722 × 1 0 11 . The error in the quaternion interpolation algorithm ( 2 . 225313 × 1 0 9 ) is lower than that of the inverse SINS algorithm in [18] ( 2 . 048823 × 1 0 7 ) . Then, the position errors of the three algorithms are compared. From Figure 4, Figure 6 and Figure 8, it can be observed that the dual quaternion interpolation algorithm developed in this study shows the highest accuracy also, with a position norm error of 2 . 575336 × 1 0 2 m. The quaternion interpolation algorithm is the second, with a position norm error of h m. The performance of the inverse SINS algorithm is the worst, with a position norm error of 3 . 063631 × 1 0 1 m. Furthermore, high order Taylor expansion approximation can be used in Equations (46) and (47) to enhance attitude and position accuracy and the algorithm’s performance. However, when comparing Equation (42) with Equation (48) and Equation (43) with Equation (49), it is observed that Equations (48) and (49) show higher order than Equations (42) and (43), although only the first-order Taylor expansion approximation is used. An increase in the order of the equations increases the time cost.
The computation time of the three algorithms is shown in Table 1. From the data in the table we can see that the computation time of the three algorithms is similar for the dataset containing 1200 data points. The algorithm based on the inverse SINS takes the most time and its accuracy is the worst among the three algorithms. Although the proposed algorithm takes slightly more time than the algorithm based on quaternion, the attitude accuracy obtained by the former one is better than that of the latter one. The longer time is acceptable.
Therefore, it can also be concluded that the analytic IMU signal generation algorithm, which is based on the actual flight data of a UAV and dual quaternion interpolations, show high accuracy. Moreover, it is capable of satisfying the requirements of dynamic simulations of SINS/GNSS integrated navigation research studies, in which simulated IMU signals are to be consistent with GNSS’s pseudoranges and their rate measurements in an actual flight test.

6. Conclusions

This paper proposed a new analytical IMU signal generation algorithm based on the dual quaternion interpolation. Compared with other algorithms, the new algorithm provides a concise analytical form for angular rate increments and specific force integral increments, and has higher accuracy than other state-of-the-art algorithms. The simulation results indicate that the quaternion error is smaller than 9 . 66 × 1 0 11 , and the position error is smaller than 0.021 m. The accuracy of the proposed algorithm is capable of satisfying the requirements of dynamic simulations of the integrated navigation.
The applications can be extended to other SINS/multi-sensor integrated navigation or rigid body motion control simulations. When the position, velocity and attitude data at discrete time epoches are given, a continuous smooth six-degrees-of-freedom (6DOF) kinematic or dynamic trajectory can always be generated through the dual quaternion interpolation.

Author Contributions

K.L. and W.W. discussed this problem and got the final ideas. K.L. wrote the paper, performed the whole experiment and completed the data analysis. W.W. and K.T. provided valuable feedbacks, advice, and mentoring during the manuscript modification. L.H. contributed to the manuscript modification and gathered information from the literature.

Funding

This work was supported in part by Research Fund for the Doctoral Program of Higher Education of China (grant number 20124307110006).

Conflicts of Interest

The authors declare no conflict of interest.

Abbreviations

The following abbreviations are used in this manuscript:
UAVUnmanned aerial vehicles
GNSSGlobal navigation satellite system
IMUInertial measurement unit
SINSStrapdown inertial navigation system
DQDual quaternions
ECIEarth-centered inertial
DOFDegrees of freedom

Appendix A. Derivation of (2)

The rotation can be described by angular rates ω i b b , and ω i b b can be calculated by ω i b b = 2 q * q ˙ , where q is the real part of the dual quaternion q .
The translation can be described by specific force f i b b . Using the relationship between ω i b b and q as reference, the following is obtained
ω i b b = 2 q * q ˙ = 2 ( q + ε p ) * ( q ˙ + ε p ˙ ) = 2 ( q * + ε p * ) ( q ˙ + ε p ˙ ) = 2 q * q ˙ + 2 ε ( q * p ˙ + p * q ˙ ) = ω i b b + ε f i b b = ω i b b + ε ( t ˙ b + ω i b b × t b )
f i b b = 2 q * p ˙ + p * q ˙ = t ˙ b + ω i b b × t b = q * f i b i q = q * a i b i g ib i q
t ˙ b = f i b b ω i b b × t b = a i b b g i b b ω i b b × C i b t i = C i b a i b i g i b i ω i b b × C i b t i
Substituting C ˙ b i = C b i ω i b b × and C ˙ i b = ω i b b × C i b in the above formula, the following is obtained:
t ˙ b = C i b a i b i g i b i + C ˙ i b t i
If A = BC , according to the rule we have A ˙ = B ˙ C + B C ˙ . For the above formula, we can rewrite it as
t ˙ b = C ˙ i b t i + C i b t ˙ i
t ˙ i = a i b i g i b i
t i = 0 t a i b i g i b i d t = v i b i 0 t g i b i d t

References

  1. Kröger, T.; Padial, J. Simple and robust visual servo control of robot arms using an on-line trajectory generator. In Proceedings of the 2012 IEEE International Conference on Robotics and Automation, Saint Paul, MN, USA, 14–18 May 2012; pp. 4862–4869. [Google Scholar]
  2. Huber, M.; Radrich, H.; Wendt, C.; Rickert, M. Evaluation of a novel biologically inspired trajectory generator in human-robot interaction. In Proceedings of the 18th IEEE International Symposium on Robot and Human Interactive Communication, Toyama, Japan, 27 September–2 October 2009; pp. 639–644. [Google Scholar]
  3. Liu, C.A.; Cheng, W.G.; Hong, Z. A trajectory generator for a mobile robot in 3D path planning. In Proceedings of the 2007 IEEE International Conference on Automation and Logistics, Jinan, Shandong, China, 18–21 August 2007; pp. 1247–1251. [Google Scholar]
  4. Alexopoulos, A.; Kandil, A.; Orzachowski, P.; Badreddin, E. A comparative study of collision avoidance techniques for unmanned aerial vehicles. In Proceedings of the 2013 IEEE International Conference on Systems, Man, and Cybernetics, Manchester, UK, 13–16 October 2013; pp. 1969–1974. [Google Scholar] [CrossRef]
  5. Pollina, M.; Desenfans, O.; Fiengo, R. Software designed GNSS system emulator. In Proceedings of the 2014 IEEE Metrology for Aerospace, Benevento, Italy, 29–30 May 2014; pp. 404–407. [Google Scholar]
  6. Cosenza, C.; Morante, Q.; Corvo, S.; Gottifredi, F. GNSS bit-true signal simulator. a test bed for receivers and applications. In Satellite Communications and Navigation Systems; Re, E.D., Ruggieri, M., Eds.; Springer: Boston, MA, USA, 2008; pp. 447–460. ISBN 978-0-387-47522-6. [Google Scholar]
  7. Wei, Z.Y.; Li, H.; Yao, Z.; Lu, M. General computing platform based GNSS signal simulator architecture: design, implementation and validation. In China Satellite Navigation Conference; Sun, J., Jiao, W., Wu, H., Lu, M., Eds.; Springer: Berlin, Heidelberg, Germany, 2014; pp. 279–294. ISBN 978-3-642-54736-2. [Google Scholar]
  8. Degen, S.C.; Alvarez, L.M.; Ford, J.J.; Walker, R.A. Tensor field guidance for time-based waypoint arrival of UAVs by 4D trajectory generation. In Proceedings of the 2009 IEEE Aerospace Cnference, Big Sky, MT, USA, 7–14 March 2009; pp. 1–7. [Google Scholar]
  9. Musick, S.H. PROFGEN—A Computer Program for Generating Flight Profiles; Air Force Avionics Lab, Wright-Patterson AFB Ohio: Dayton, OH, USA, 1976. [Google Scholar]
  10. Shortelle, K.J.; Graham, W.R.; Rabourn, C. F-16 flight tests of a rapid transfer alignment procedure. In Proceedings of the IEEE 1998 Position Location and Navigation Symposium, Palm Springs, CA, USA, 20–23 April 1996; pp. 379–386. [Google Scholar]
  11. Li, G.X.; Mao, Y.L.; Song, C.L. Design and simulation of trajectory generator. In Proceedings of the 2012 4th International Conference on Intelligent Human-Machine Systems and Cybernetics, Nanchang, China, 26–27 August 2012; pp. 201–204. [Google Scholar]
  12. Zhou, W.J.; Liu, J.; Lei, H.J. A Simulation Platform Design for Strap-down Inertial Navigation System Design and Validation. J. Proj. Rocket. Missiles Guid. 2011, 31, 11–14. [Google Scholar]
  13. Xu, J.S.; Qin, H.; Gao, Y.; Feng, L.B. Design and Application of Simulation Flight Trajectory. Avion. Technol. 2012, 43, 25–29. [Google Scholar]
  14. Li, J.W.; Cheng, Y.M.; Chen, K.Z.; Song, C.H. Test platform for SINS algorithm based on flight simulation. J. Chin. Inert. Technol. 2012, 20, 530–535. [Google Scholar]
  15. Brunner, T.; Lauffenburger, J.P.; Changey, S.; Basset, M. Magnetometer- augmented IMU aimulator: In-depth elaboration. Sensors 2015, 15, 5293–5310. [Google Scholar] [CrossRef] [PubMed]
  16. Li, Z.; Cai, Z.X.; Ren, X.P.; Chen, A.B.; Xue, Z.C. Vehicle kinematics modeling and design of vehicle trajectory generator system. J. Cent. South Univ. 2012, 19, 2860–2865. [Google Scholar] [CrossRef]
  17. Chen, K.; Wei, F.; Zhang, Q.C.; Yu, Y.F.; Yan, J. Trajectory generator of SINS on flight dynamics with application in hardware-in-the-loop simulation. J. Chin. Inert. Technol. 2014, 22, 486–491. [Google Scholar]
  18. Yan, G.M.; Wang, J.L.; Zhou, X.Y. High-precision simulator for strapdown inertial navigation systems based on real dynamics from GNSS and IMU integration. In China Satellite Navigation Conference; Sun, J., Liu, J., Fan, S., Lu, X., Eds.; Springer: Berlin/Heidelberg, Germany, 2015; pp. 789–799. ISBN 978-3-662-46631-5. [Google Scholar]
  19. Liu, K.; Wu, W.Q.; Tang, K.H.; Wen, K. Trajectory generator for INS/GNSS integration simulation through real flight data interpolation. J. Natl. Univ. Def. Technol. 2018, 40, 132–137. [Google Scholar]
  20. Branets, V.N.; Shmyglevsky, I.P. Introduce to the Theory of Strapdown Inertial Navigation System, Nauka: Moscow, Russia, 1973. Chapter 3 (In Russian)
  21. Wu, Y.X.; Hu, X.P.; Hu, D.W.; Li, T.; Lian, J.X. Strapdown inertial navigation system algorithms based on dual quaternions. IEEE Trans. Aerosp. Electron. Syst. 2005, 41, 110–132. [Google Scholar]
  22. Wang, Z.H.; Chen, X.J.; Zeng, Q.S. Comparison of strapdown inertial navigation algorithm based on rotation vector and dual quaternion. Chin. J. Aeronaut. 2013, 26, 442–448. [Google Scholar]
  23. Deuflhard, P.; Hohmann, A. Interpolation and Approximation. In Walter Gautschi; Springer: New York, NY, USA, 2003; pp. 179–235. ISBN 978-1-4419-2990-7. [Google Scholar]
  24. Groves, P.D. Principles of GNSS, Inertial and Multisensor Integrated Navigation Systems; Artech House: London, UK, 2008; pp. 15–54, 121–160, 361–406, 419–448. ISBN 1608070050. [Google Scholar]
Figure 1. Algorithm flow chart.
Figure 1. Algorithm flow chart.
Sensors 18 02721 g001
Figure 2. Actual flight trajectory.
Figure 2. Actual flight trajectory.
Sensors 18 02721 g002
Figure 3. Curve of the quaternion error (based on DQ).
Figure 3. Curve of the quaternion error (based on DQ).
Sensors 18 02721 g003
Figure 4. Curve of the position error (based on DQ).
Figure 4. Curve of the position error (based on DQ).
Sensors 18 02721 g004
Figure 5. Curve of the quaternion error (based on the inverse SINS).
Figure 5. Curve of the quaternion error (based on the inverse SINS).
Sensors 18 02721 g005
Figure 6. Curve of the position error (based on the inverse SINS).
Figure 6. Curve of the position error (based on the inverse SINS).
Sensors 18 02721 g006
Figure 7. Curve of the quaternion error (based on the quaternion).
Figure 7. Curve of the quaternion error (based on the quaternion).
Sensors 18 02721 g007
Figure 8. Curve of position error (based on quaternion).
Figure 8. Curve of position error (based on quaternion).
Sensors 18 02721 g008
Table 1. The computation time of the three algorithms.
Table 1. The computation time of the three algorithms.
Algorithm Proposed in This PaperAlgorithm Based on Inverse SINSAlgorithm Based on Quaternion
784.74 s813.14 s750.92 s

Share and Cite

MDPI and ACS Style

Liu, K.; Wu, W.; Tang, K.; He, L. IMU Signal Generator Based on Dual Quaternion Interpolation for Integration Simulation. Sensors 2018, 18, 2721. https://0-doi-org.brum.beds.ac.uk/10.3390/s18082721

AMA Style

Liu K, Wu W, Tang K, He L. IMU Signal Generator Based on Dual Quaternion Interpolation for Integration Simulation. Sensors. 2018; 18(8):2721. https://0-doi-org.brum.beds.ac.uk/10.3390/s18082721

Chicago/Turabian Style

Liu, Ke, Wenqi Wu, Kanghua Tang, and Lei He. 2018. "IMU Signal Generator Based on Dual Quaternion Interpolation for Integration Simulation" Sensors 18, no. 8: 2721. https://0-doi-org.brum.beds.ac.uk/10.3390/s18082721

Note that from the first issue of 2016, this journal uses article numbers instead of page numbers. See further details here.

Article Metrics

Back to TopTop