A Preferable Airborne Integrated Navigation Method Based...

15
Research Article A Preferable Airborne Integrated Navigation Method Based on INS and GPS Xiaoyue Zhang and Kaiwen Ning School of Instrumentation Science and Optoelectronics Engineering, Beihang University, Beijing 100191, China Correspondence should be addressed to Xiaoyue Zhang; [email protected] Received 24 August 2017; Revised 10 January 2018; Accepted 6 February 2018; Published 19 June 2018 Academic Editor: Eduard Llobet Copyright © 2018 Xiaoyue Zhang and Kaiwen Ning. This is an open access article distributed under the Creative Commons Attribution License, which permits unrestricted use, distribution, and reproduction in any medium, provided the original work is properly cited. An integrated navigation method based on INS and GPS was proposed for airborne navigation. The inuence of scale factor error and misalignment error of gyroscope and accelerometer on navigation accuracy was analyzed. Compared with traditional INS/GPS integrated navigation method, scale factor error and misalignment error were added to the state model of the integrated navigation system. The observability of scale factor error and misalignment error was analyzed combined with typical airborne movement. Then the integrated system was optimized, and the new navigation model of the integrated system was obtained. The optimized INS/GPS integrated model was validated by numerical simulation and turntable test. Comparing the proposed model with traditional integrated model (integrated system error states do not include scale factor error and misalignment error), the results showed that the proposed integrated navigation method can improve the accuracy from 8% to 28% of the east, north, and upward positions. 1. Introduction Inertial navigation system (INS) is an autonomous naviga- tion system that does not depend on any external informa- tion [1, 2]. However, the characteristics of the location error accumulate with time, making it dicult to work independently for a long time. Global Positioning System (GPS) can measure three-dimensional position and velocity accurately, but the disadvantage is susceptible to interfer- ence and control [35]. Therefore, INS and GPS have complementary characteristics. Since the 1990s, INS/GPS integrated navigation system has been a great success at home and abroad, and it has developed into a specialized technology [6, 7]. INS/GPS integrated navigation system works as follows: when GPS signal is good, the system selects the integrated navigation mode. The precision of integrated navigation basically depends on GPS precision, and the inertial mea- surement unit (IMU) errors can be estimated and compen- sated online. When GPS signal is disturbed or shielded, the system automatically shifts into inertial navigation mode. At this point, navigation accuracy basically depends on the precision of IMU [8]. Therefore, the estimation accuracy of IMU errors in integrated navigation can aect the accuracy of the subsequent inertial navigation [9, 10]. In airborne INS/GPS integrated navigation system, however, the errors of IMU only consider the bias of gyroscope and accelerome- ter without considering scale factor and misalignment at present. A method of the dynamic parameter identication of the scale factor error and misalignment error was designed based on Kalman lter. The observability of the scale factor error and misalignment error with dierent maneuvers was analyzed in [11]. Zhou et al. described the error dynamic system equation and observation equation of inertial naviga- tion system and the singular value of the system states of online calibration [12]. Therefore, a more advanced method can be designed to make the IMU errors (including bias, scale factor, and misalignment) be more accurate in estimation and compensation in the integrated navigation process. When entering the inertial navigation mode, it can get higher navigation accuracy. For the application of airborne navigation, this paper analyzes the inuence of scale factor error and misalignment error on the accuracy of integrated navigation. Based on the Hindawi Journal of Sensors Volume 2018, Article ID 7342896, 14 pages https://doi.org/10.1155/2018/7342896

Transcript of A Preferable Airborne Integrated Navigation Method Based...

Page 1: A Preferable Airborne Integrated Navigation Method Based ...downloads.hindawi.com/journals/js/2018/7342896.pdf · Research Article A Preferable Airborne Integrated Navigation Method

Research ArticleA Preferable Airborne Integrated Navigation Method Based onINS and GPS

Xiaoyue Zhang and Kaiwen Ning

School of Instrumentation Science and Optoelectronics Engineering, Beihang University, Beijing 100191, China

Correspondence should be addressed to Xiaoyue Zhang; [email protected]

Received 24 August 2017; Revised 10 January 2018; Accepted 6 February 2018; Published 19 June 2018

Academic Editor: Eduard Llobet

Copyright © 2018 Xiaoyue Zhang and Kaiwen Ning. This is an open access article distributed under the Creative CommonsAttribution License, which permits unrestricted use, distribution, and reproduction in any medium, provided the original workis properly cited.

An integrated navigation method based on INS and GPS was proposed for airborne navigation. The influence of scale factor errorand misalignment error of gyroscope and accelerometer on navigation accuracy was analyzed. Compared with traditional INS/GPSintegrated navigation method, scale factor error and misalignment error were added to the state model of the integrated navigationsystem. The observability of scale factor error and misalignment error was analyzed combined with typical airborne movement.Then the integrated system was optimized, and the new navigation model of the integrated system was obtained. The optimizedINS/GPS integrated model was validated by numerical simulation and turntable test. Comparing the proposed model withtraditional integrated model (integrated system error states do not include scale factor error and misalignment error), the resultsshowed that the proposed integrated navigation method can improve the accuracy from 8% to 28% of the east, north, andupward positions.

1. Introduction

Inertial navigation system (INS) is an autonomous naviga-tion system that does not depend on any external informa-tion [1, 2]. However, the characteristics of the locationerror accumulate with time, making it difficult to workindependently for a long time. Global Positioning System(GPS) can measure three-dimensional position and velocityaccurately, but the disadvantage is susceptible to interfer-ence and control [3–5]. Therefore, INS and GPS havecomplementary characteristics. Since the 1990s, INS/GPSintegrated navigation system has been a great success athome and abroad, and it has developed into a specializedtechnology [6, 7].

INS/GPS integrated navigation system works as follows:when GPS signal is good, the system selects the integratednavigation mode. The precision of integrated navigationbasically depends on GPS precision, and the inertial mea-surement unit (IMU) errors can be estimated and compen-sated online. When GPS signal is disturbed or shielded, thesystem automatically shifts into inertial navigation mode.At this point, navigation accuracy basically depends on the

precision of IMU [8]. Therefore, the estimation accuracy ofIMU errors in integrated navigation can affect the accuracyof the subsequent inertial navigation [9, 10]. In airborneINS/GPS integrated navigation system, however, the errorsof IMU only consider the bias of gyroscope and accelerome-ter without considering scale factor and misalignment atpresent. A method of the dynamic parameter identificationof the scale factor error and misalignment error was designedbased on Kalman filter. The observability of the scale factorerror and misalignment error with different maneuvers wasanalyzed in [11]. Zhou et al. described the error dynamicsystem equation and observation equation of inertial naviga-tion system and the singular value of the system states ofonline calibration [12]. Therefore, a more advanced methodcan be designed to make the IMU errors (including bias, scalefactor, and misalignment) be more accurate in estimationand compensation in the integrated navigation process.When entering the inertial navigation mode, it can get highernavigation accuracy.

For the application of airborne navigation, this paperanalyzes the influence of scale factor error and misalignmenterror on the accuracy of integrated navigation. Based on the

HindawiJournal of SensorsVolume 2018, Article ID 7342896, 14 pageshttps://doi.org/10.1155/2018/7342896

Page 2: A Preferable Airborne Integrated Navigation Method Based ...downloads.hindawi.com/journals/js/2018/7342896.pdf · Research Article A Preferable Airborne Integrated Navigation Method

analysis, the scale factor error and the misalignment error areadded to the error model of the integrated navigation system.Then the observability of the scale factor error and misalign-ment error is analyzed combined with the typical airbornemovement. According to the observability analysis results,the integrated system is optimized and the new error modelof the integrated navigation system is obtained. Finally, theoptimized INS/GPS integrated model proposed in this paperis validated by numerical simulation and turntable test, andthen the proposed model is compared with the traditionalintegrated model.

2. Error Analysis of Airborne InertialMeasurement Unit

The errors of inertial measurement unit mainly includebias, scale factor error and misalignment error. The errormodel of INS and IMU is given in the following passage,and the influence of IMU errors on the navigation accuracyis analyzed combined typical airborne movement.

2.1. Error Model of Inertial Navigation System.

δλ =vnE tan L sec L

RN + hδL −

vnE sec LRN + h 2 δh +

sec LRN + h

δvnE,

δL = −vnN

RM + h 2 δh +1

RM + hδvnN ,

δh = δvnU ,

δvn = fn × φ − 2ωnie + ωn

en × δvn + vn × 2δωnie + δωn

en + δfn,φ = − ωn

ie + ωnen × φ + δωn

ie + δωnen − εn,

1

where δλ, δL, and δh represent the longitude error, thelatitude error, and the altitude error, respectively, and RMand RN are the curvature radius of the meridian and primevertical. δvn and φ represent velocity error and attitude error,respectively, and δfn represents the accelerometer measure-ment error, which contains accelerometer bias, scale factorerror, and misalignment error. εn represents the gyroscopemeasurement error, which contains gyroscope bias, scalefactor error, and misalignment error.

2.2. Error Model of Inertial Measurement Unit.

εbx

εby

εbz

=

gBx

gBy

gBz

+

gSFx gMAxy gMAxz

gMAyx gSFy gMAyz

gMAzx gMAzy gSFz

ωbibx

ωbiby

ωbibz

,

2

where gSFx, gSFy, and gSFz are the gyroscope scale factorerrors of the x-axis, y-axis, and z-axis. gMAxy, gMAxz ,gMAyx, gMAyz , gMAzx, and gMAzy are the gyroscope

misalignment errors. gBx, gBy, and gBz are the gyroscope

biases. ωbibx, ω

biby , and ωb

ibz are the gyroscope ideal outputs.

δf bx

δf by

δf bz

=

aBx

aBy

aBz

+

aSFx aMAxy aMAxz

aMAyx aSFy aMAyz

aMAzx aMAzy aSFz

f bx

f by

f bz

,

3

where aSFx, aSFy, and aSFz are the accelerometer scalefactor errors of the x-axis, y-axis, and z-axis. aMAxy ,aMAxz , aMAyx, aMAyz , aMAzx, and aMAzy are the acceler-ometer misalignment errors. aBx, aBy, and aBz are the

accelerometer biases. f bix , fby , and f bz are the accelerometer

ideal outputs [13].

2.3. Analysis of the Influence of IMU Errors on NavigationAccuracy. In order to facilitate quantitative analysis, com-bined with the actual low-precision inertial navigationsystems commonly used in airborne navigation, the errorparameters of the IMU are set as follows:

gB = 1°/h,

gSFx = gSFy = gSFz = 300 ppm,

gMAxy = gMAxz = gMAyx = gMAyz = gMAzx = gMAzy = 40″,aB = 500 μg,

aSFx = aSFy = aSFz = 300 ppm,

aMAxy = aMAxz = aMAyx = aMAyz = aMAzx = aMAzy = 40″4

2.3.1. Analysis of Attitude Error. In order to more clearly andeasily analyze the influence of gyroscope scale factor errorand misalignment error on attitude error, we temporarilydo not consider other terms. The attitude error equationcan be simplified as

φ = −Cnb

gSFx gMAxy gMAxz

gMAyx gSFy gMAyz

gMAzx gMAzy gSFz

ωbibx

ωbiby

ωbibz

+

gBx

gBy

gBz

= −Cnb δKGωb

ib + gB

5

When the airframe turns, the angular velocity of theEarth and the platform are small relative to the IMU rotationrate. So we ignore the influence of angular velocity of theEarth and the platform on the attitude error; the attitudeerror equation is further simplified [14]:

φ = −Cnb δKG ωb

in +ωbnb + gB ≈ −Cn

b δKGωbnb + gB

6

2 Journal of Sensors

Page 3: A Preferable Airborne Integrated Navigation Method Based ...downloads.hindawi.com/journals/js/2018/7342896.pdf · Research Article A Preferable Airborne Integrated Navigation Method

When the system only changes the pitch angle, theroll angle and heading angle change could be assumedto be zero, then

ωbnb = ωx 0 0 T , Cn

b ≈

1 0 0

0 cos θ −sin θ

0 sin θ cos θ

7

Substituting (7) into (6),

φ = −ωx ⋅

gSFx

cos θ ⋅ gMAyx − sin θ ⋅ gMAzx

cos θ ⋅ gMAzx + sin θ ⋅ gMAyx

gBx

cos θ ⋅ gBy − sin θ ⋅ gBz

cos θ ⋅ gBz + sin θ ⋅ gBy

8

Combined with the gyroscope error parameters givenabove and (8), the influence of gyroscope scale factor errorgSFx on attitude error is greater than that of gyroscope biasgBx on attitude error when ωx > 0 93°/s; the influenceof gyroscope misalignment errors gMAyx and gMAzx onattitude error is greater than that of gyro bias gBx andgBz on attitude error when ωx > 1 43°/s. Therefore, whenthe body pitch angle changes, the influence of gyroscopescale factor error and misalignment error on attitude errorcannot be ignored.

Similarly, when the system roll angle changes or headingangle changes, then ωb

nb is

ωbnb = 0 ωy 0 T or ωb

nb = 0 0 ωzT 9

Substituting (9) into (6), we can get the same conclusion.

2.3.2. Error Analysis of Velocity and Position. The mostcommon movements of the aircraft are uniform motionand accelerated motion, this paper mainly analyzes theinfluence of the accelerometer errors on position error andvelocity error in these two kinds of motion. To simplify theanalysis, this paper also does not consider other error terms,so velocity error equation can be simplified as

δvn =Cnb

aSFx aMAxy aMAxz

aMAyx aSFy aMAyz

aMAzx aMAzy aSFz

f bx

f by

f bz

+

aBx

aBy

aBz

=Cnb δKA fbsf + aB

10

When the system only changes the pitch angle, the rollangle and heading angle change could be assumed to be zero;the attitude matrix Cn

b can be simplified as

Cnb =

1 0 0

0 cos θ −sin θ

0 sin θ cos θ

11

Substituting (11) into (10),

δvn =

δvnE

δvnN

δvnU

aBx

cos θ ⋅ aBy − sin θ ⋅ aBz

cos θ ⋅ aBz + sin θ ⋅ aBy

+ f x ⋅

aSFx

cos θ ⋅ aMAyx − sin θ ⋅ aMAzx

sin θ ⋅ aMAyx + cos θ ⋅ aMAzx

+ f y ⋅

aMAxy

cos θ ⋅ aSFy − sin θ ⋅ aMAzy

sin θ ⋅ aSFy + cos θ ⋅ aMAzy

+ g ⋅

aMAxz

cos θ ⋅ aMAyz − sin θ ⋅ aSFz

sin θ ⋅ aMAyz + cos θ ⋅ aSFz12

In uniformmotion (f x = f y ≈ 0), according to the acceler-ometer error parameters and (12), we can conclude that aMA ⋅ g ≈ 194 μg < aB = 500 μg. The influence of accelerometermisalignment errors aMAxz and aMAyz on the east and northvelocity errors is about 40% of the bias aBx and aBy. Inaddition, aSFz ⋅ g ≈ 300 μg < aBz = 500 μg. The influence ofthe accelerometer scale factor error aSFz on upward velocityerror is about 60% of accelerometer bias aBz . Therefore,the influence of the accelerometer scale factor error andmisalignment error on velocity error cannot be ignoredin uniform motion.

In accelerated motion (f x ≠ 0, f y ≠ 0), according to theaccelerometer error parameters and (12), we can concludethat when f y > 1 67g and f z > 1 67g, the influence of theaccelerometer scale factor errors aSFy and aSFz on the northvelocity error and upward velocity error is greater than thatof accelerometer bias aBy and aBz .When f y > 2 57g andf z > 2 57g, the influence of the accelerometer misalign-ment errors aMAzy and aMAyz on the north velocity errorand upward velocity error is greater than that of acceler-ometer bias aBz and aBy. In the actual motion, theacceleration of aircraft is about 0.3g. According to theanalysis above, the influence of the accelerometer scale

3Journal of Sensors

Page 4: A Preferable Airborne Integrated Navigation Method Based ...downloads.hindawi.com/journals/js/2018/7342896.pdf · Research Article A Preferable Airborne Integrated Navigation Method

factor error on velocity error is about 18% of the accelerom-eter bias and the influence of accelerometer misalignmenterror on velocity error is 12% of the accelerometer bias inaccelerated movement.

Similarly, when the system’s roll angle changes orheading angle changes, attitude matrix Cn

b is

Cnb ≈

cos γ 0 sin γ

0 1 0

−sin γ 0 cos γ

or Cnb ≈

cos ψ sin ψ 0

−sin ψ cos ψ 0

0 0 113

Substituting (13) into (10), we can get the sameconclusion.

In summary, the influence of scale factor error andmisalignment error of gyroscope and accelerometer onnavigation cannot be ignored.

3. Model Establishment

3.1. INS/GPS Integrated Navigation Model. From what hasbeen analyzed above, we can conclude that the influenceof scale factor error and misalignment error on naviga-tion cannot be ignored in airborne navigation. Therefore,the scale factor error and misalignment error need to beconsidered in the INS/GPS integrated error model. In thispaper, INS/GPS integrated navigation is realized by usingKalman filter. The position and velocity differences betweenGPS and INS are taken as measurement errors. IMU errorsand navigation errors can be online estimated and compen-sated, so the high navigation accuracy can be acquired.INS/GPS integrated navigation schematic diagram is shownin Figure 1.

3.1.1. Error State Model of Integrated Navigation. Theintegrated system error model can be expressed as

X t = F t X t +G t W t 14

X t is the 33-dimensional error vector of integratedsystem which can be expressed as

X t = δL δλ δh δvnE δvnN δvnU φE φN φU aBx aBy aBz gBx gBy

gBz aSFx aSFy aSFz aMAxy aMAxz aMAyx aMAyz

aMAzx aMAzy gSFx gSFy gSFz gMAxy gMAxz gMAyx

gMAyz gMAzx gMAzyT ,

15

W t is the system noise model which can be expressed as

W t = 01×3 aWx aWy aWz gWx gWy gWz 01×24T,

16

where aWx, aWy, and aWz are accelerometer noises, gWx ,gWy , and gWz are gyroscope noises.

G t is the noise driving matrix of integrated system,

G t =

03×3 03×3 03×303×3 Cn

b 03×303×3 03×3 Cn

b

09×24

024×9 024×24

17

3.1.2. Measurement Model of Integrated Navigation. Thevelocity and position differences between GPS and INS aretaken as measurement errors in the process of integratednavigation. So the measurement equation can be expressed as

Z t =Hp

HV

X t +Vp

VV

,

Hp =

0 R cos L 0⋮

R 0 0⋮ 03×300 0 0⋮

,

HV = 03×3 I3 03×27

18

VP and VV are the measurement noises of position andvelocity, respectively [15–17].

SINS

Error compensation,navigation calculation

Velocity, position,attitude

Sensor error

Data fusion

Velocity,positionNavigation

calculation

GPS receiver

Satellite basebandsignal processingRF front end

Gyroscope,accelerometer

Outputcorrection

information

Output the bestestimation

Figure 1: INS/GPS integrated navigation schematic.

4 Journal of Sensors

Page 5: A Preferable Airborne Integrated Navigation Method Based ...downloads.hindawi.com/journals/js/2018/7342896.pdf · Research Article A Preferable Airborne Integrated Navigation Method

3.2. Airborne INS/GPS Integrated System Optimization. Scalefactor error and misalignment error are added in the newintegrated model. However, the scale factor error and mis-alignment error cannot be observed completely. It is difficultto obtain the desired estimation results if the estimated statescannot be observed. So the observability of the scale factorerror and misalignment error is analyzed by a combinedtypical airborne trajectory. Based on the analysis of observ-ability, we delete unobservable error states and get theoptimized integrated navigation model.

3.2.1. Observability Analysis. In this paper, the movementof aircraft is divided into the following three typical pro-cesses: straight flight, climbing flight, and turning flight.Straight flight includes uniform motion and acceleratedmotion. Climbing flight includes preparation for climbing,climbing, and transformation level. Turning flight includestilting and spiral. Flight trajectory consists of the threeprocesses above. Considering the complexity of the proce-dure, this paper does not simulate the whole flight pro-cess but chooses nine typical stages [18, 19]. The flightstages of aircraft and simulation trajectory are shown inTable 1 and Figure 2.

With the combined typical flight trajectory above,according to the eigenvalues of the error covariance matrix,

the observability of the scale factor error and misalignmenterror of the gyroscope and accelerometer is analyzed indifferent maneuvering conditions. And the influence ofdifferent maneuvering conditions on observability of eacherror term is analyzed. The eigenvalues of the covariancematrix can reflect whether the system state estimation isgood or bad. The smaller the eigenvalue is, the smallerthe estimated variance of the corresponding state is andthe better the degree of observability is. Otherwise, theestimation accuracy is low and the degree of observabilityis poor.

Figures 3 and 4 are the normalized eigenvalues of thecorresponding errors in the covariance matrix during thewhole motion. Tables 2 and 3 are the normalized covari-ance of scale error and misalignment error of gyroscopeand accelerometer.

As can be seen from Figure 3 and Table 2, the scale factorerror and misalignment error of gyroscope are not observableduring gliding. When climbing, the degree of observabilityof gSFx is increased. In a uniform flight, the flight time islong and the observability of gSFx and gMAyx is significantlyincreased. The degree of observability of gSFy and gMAyz isincreased when circling to the left and the degree of observ-ability of gMAxz is increased during circle exit. It can beseen that rotational maneuvering has a good incentive

Table 1: The flight stages of aircraft.

Flight stage Duration (s) Acceleration (m/s2) Yaw (°) Yaw rate (°/s) Pitch (°) Pitch rate (°/s) Roll (°) Roll rate (°/s)

Glide 20 2.5 45 0 0 0 0 0

Preparation for climbing 5 0 45 0 0 6 0 0

Climbing 100 0 45 0 30 0 0 0

Transformation level 5 0 45 0 30 −6 0 0

Uniform flight 200 0 45 0 0 0 0 0

Tilt to the left 20 0 45 0 0 0 0 1

Circle to the left 45 0 45 2 0 0 20 0

Exit circle 20 0 135 0 0 0 20 −1Uniform flight 285 0 135 0 0 0 0 0

39.9540

40.0540.1

116.3116.4

116.5116.6

116.7116.8

0

500

1000

1500

2000

2500

3000

Latitude (°)Longitude (°)

Alti

tude

(m)

Figure 2: The flight trajectory of aircraft.

5Journal of Sensors

Page 6: A Preferable Airborne Integrated Navigation Method Based ...downloads.hindawi.com/journals/js/2018/7342896.pdf · Research Article A Preferable Airborne Integrated Navigation Method

for gSFy, gMAyz , and gMAxz . So gSFx, gSFy, gMAxz ,gMAyx, and gMAyz are observable. Moreover, at the endof the whole movement, the normalized covariance ofgSFz , gMAxy, gMAzx, and gMAzy are decreased not obviously.In summary, gSFz , gMAxy , gMAzx, and gMAzy of gyroscopeerrors are unobservable.

As can be seen from Figure 4 and Table 3, thedegree of observability of scale factor error aSFz isincreased during accelerated gliding. The change of theobservability degree of scale factor error and misalignmenterror is not obvious during climbing and transformationlevel. In a uniform flight, the degree of observability of

0.7

0.8

0.9

1

gSF x

5000 300 400100 200t (s)

(a)

0.7

0.8

0.9

1

gSF y

100 200 300 400 5000t (s)

(b)

0.94

0.96

0.98

1

gSF z

100 200 300 400 5000t (s)

(c)

100 200 300 400 5000t (s)

0.9

0.92

0.94

0.96

0.98

1

gMAxy

(d)

0 100 200 300 400 5000.8

0.85

0.9

0.95

1

t (s)

gMAxz

(e)

0.8

0.85

0.9

0.95

1

gMAyx

100 200 300 400 5000t (s)

(f)

100 200 300 400 5000t (s)

0.75

0.8

0.85

0.9

0.95

1

gMAyz

(g)

100 200 300 400 5000t (s)

0.98

0.985

0.99

0.995

1

gMAzx

(h)

0.999

0.9992

0.9994

0.9996

0.9998

1

gMAzy

100 200 300 400 5000t (s)

(i)

Figure 3: Eigenvalues of covariance matrix corresponding to gyroscope errors.

6 Journal of Sensors

Page 7: A Preferable Airborne Integrated Navigation Method Based ...downloads.hindawi.com/journals/js/2018/7342896.pdf · Research Article A Preferable Airborne Integrated Navigation Method

aSFy and aMAxy is significantly increased. The degree ofobservability of aMAzx is increased during circling to theleft and exit circle. So aSFy, aSFz , aMAxy, and aMAzx areobservable. Moreover, at the end of the whole movement,the normalized covariance of aSFx, aMAxz , aMAyx, aMAyz ,and aMAzy are decreased not obviously. In summary, aSFx,

aMAxz , aMAyx , aMAyz , and aMAzy of accelerometer errorsare unobservable.

3.2.2. Optimization of Integrated System. As can be seenfrom the observability analysis results, the error statesgSFz , gMAxy, gMAzx, gMAzy, aSFx, aMAxz , aMAyx, aMAyz ,

0.95

0.96

0.97

0.98

0.99

1

aSF x

100 200 300 400 5000t (s)

(a)

0.7

0.8

0.9

1

aSF y

100 200 300 400 5000t (s)

(b)

0.75

0.8

0.85

0.9

0.95

1

aSF z

100 200 300 400 5000t (s)

(c)

0.8

0.85

0.9

0.95

1

aMAxy

100 200 300 400 5000t (s)

(d)

0.9

0.92

0.94

0.96

0.98

1

aMAxz

100 200 300 400 5000t (s)

(e)

0.96

0.97

0.98

0.99

1

aMAyx

100 200 300 400 5000t (s)

(f)

0.9

0.92

0.94

0.96

0.98

1

aMAyz

100 200 300 400 5000t (s)

(g)

0.8

0.85

0.9

0.95

1

aMAzx

100 200 300 400 5000t (s)

(h)

0.95

0.96

0.97

0.98

0.99

1

aMAzy

100 200 300 400 5000t (s)

(i)

Figure 4: Eigenvalues of covariance matrix corresponding to accelerometer errors.

7Journal of Sensors

Page 8: A Preferable Airborne Integrated Navigation Method Based ...downloads.hindawi.com/journals/js/2018/7342896.pdf · Research Article A Preferable Airborne Integrated Navigation Method

and aMAzy are unobservable. After the unobservable errorsare deleted, the dimensions of the error states is reduced from33 to 24 and the optimized error state vector of the integratedsystem is

X t = δL δλ δh δvnE δvnN δvnU φE φN φU aBx aBy aBz gBx gBy

gBz aSFy aSFz aMAxy aMAzx gSFx gSFy gMAxz

gMAyx gMAyzT

19

So the system noise vector and the noise driving matrix ofthe integrated system are

W t = 01×3 aWx aWy aWz gWx gWy gWz 01×15 ,

G t =

03×3 03×3 03×303×3 Cn

b 03×3 09×1503×3 03×3 Cn

b

015×9 015×15

20

The measurement matrix is expressed as

Hp =

0 R cos L 0⋮

R 0 0⋮ 03×210 0 0⋮

,

Hv = 03×3 I3 03×18

21

In this way, the optimized integrated model is obtained,and then the simulation and turntable test are used to verifythe optimized model, respectively.

4. Model Verification

4.1. Simulation Verification. In this paper, numerical simula-tion is used to verify the validity and correctness of the pro-posed INS/GPS integrated model and then compare it withtraditional integrated model.

The error parameters of IMU and GPS are as follows:

(1) Gyroscope

(i) Bias: 1°/h; noise: 0 05°/ h

Table 3: Normalized covariance of accelerometer scale factor and misalignment.

Error state Initial value GlidePreparationfor climbing

ClimbingTransformation

levelUniformflight

Tilt to the leftCircle tothe left

Exit circle Final value

aSFx 1.00 1.00 1.00 1.00 1.00 1. 00 0.99 0.98 0.95 0.95

aSFy 1.00 0.99 0.99 0.95 0.95 0.75 0.73 0.69 0.69 0.69

aSFz 1.00 0.91 0.88 0.85 0.84 0.80 0.80 0.80 0.79 0.79

aMAxy 1.00 0.99 0.99 0.99 0.99 0.85 0.84 0.83 0.83 0.83

aMAxz 1.00 0.97 0.96 0.96 0.96 0.94 0.94 0.92 0.92 0.92

aMAyx 1.00 1.00 1.00 1.00 1.00 1.00 0.99 0.98 0.97 0.97

aMAyz 1.00 0.97 0.96 0.95 0.95 0.92 0.92 0.92 0.92 0.92

aMAzx 1.00 1.00 1.00 1.00 1.00 1.00 0.99 0.93 0.88 0.84

aMAzy 1.00 1.00 1.00 1.00 1.00 0.98 0.98 0.97 0.96 0.95

Table 2: Normalized covariance of gyroscope scale factor and misalignment.

Error state Initial value GlidePreparationfor climbing

ClimbingTransformation

levelUniformflight

Tilt tothe left

Circle tothe left

Exit circle Final value

gSFx 1.00 1.00 0.99 0.91 0.91 0.72 0.72 0.70 0.69 0.69

gSFy 1.00 1.00 1.00 1.00 1.00 1.00 0.99 0.88 0.87 0.71

gSFz 1.00 1.00 1.00 1.00 1.00 1.00 1.00 0.99 0.97 0.95

gMAxy 1.00 1.00 1.00 1.00 1.00 1.00 0.99 0.94 0.94 0.92

gMAxz 1.00 1.00 1.00 1.00 1.00 1.00 1.00 0.91 0.86 0.85

gMAyx 1.00 1.00 0.99 0.96 0.96 0.83 0.82 0.80 0.80 0.80

gMAyz 1.00 1.00 1.00 1.00 1.00 1.00 1.00 0.88 0.80 0.76

gMAzx 1.00 1.00 1.00 0.99 0.99 0.98 0.98 0.98 0.98 0.98

gMAzy 1.00 1.00 1.00 1.00 1.00 1.00 1.00 0.99 0.99 0.99

8 Journal of Sensors

Page 9: A Preferable Airborne Integrated Navigation Method Based ...downloads.hindawi.com/journals/js/2018/7342896.pdf · Research Article A Preferable Airborne Integrated Navigation Method

(ii) Scale factor error: 300 ppm; misalignment error:40″

(2) Accelerometer

(i) Bias: 500μg; noise: 100 μg/ Hz

(ii) Scale factor error: 300 ppm; misalignment error:40″

(3) GPS Receiver

(i) Position error: level 3m, vertical 5m

(ii) Velocity error: level 0.05m/s, vertical 0.05m/s

The simulation time is 700 seconds, the first 500 secondsfor INS/GPS integrated navigation. GPS failure after 500seconds, the receiver cannot output velocity and positioninformation. At this time, integrated system cannot updatemeasurement equation and turns into inertial navigationmode. The simulation results are as follows, Figure 5 showsthe estimation of gyroscope bias, scale factor error, andmisalignment error in integrated navigation. Figure 6 showsthe estimation of accelerometer bias, scale factor error, andmisalignment error in integrated navigation. Figure 7 showsthe true value, estimation of position and position error ofthe traditional integrated navigation model, and the pro-posed navigation model in the whole simulation process,including the east position, the north position, and theupward position.

From the simulation results above, the set errors of gyro-scope bias, scale factor, and misalignment are 1°/h, 300 ppm,and 40″, respectively. Figure 3 shows that the error estima-tion of the gyroscope are 0.96°/h, 305 ppm, and 42.8″, respec-tively. The set errors of accelerometer bias, scale factor, andmisalignment are 500μg, 300 ppm, and 40″, respectively.Figure 4 shows that the error estimation of the accelerometerare 482μg, 297 ppm, and 43″, respectively. Therefore, theobservable errors of IMU are effectively estimated in inte-grated navigation.

GPS signal is lost after 500 seconds; system conducted200 seconds inertial navigation at 700 seconds. Figure 7shows that the east, north, and upward position errors ofthe traditional model are 380m, 231.4m, and 126.1m,respectively. The east, north, and upward position errors ofthe proposed model are 271.2m, 175.1m, and 111.5m,respectively. The navigation accuracy of the east, north, andupward positions of the proposed model improved by28.6%, 24.3%, and 8.3%, respectively.

4.2. Turntable Test. Numerical simulation has proved thevalidity of the proposed integrated navigation method. Inorder to further verify the effectiveness of the method inactual integrated navigation system, turntable test is designedon the basis of numerical simulation. Test equipment includeINS/GPS integrated navigation system, turntable, two-wayDC power supply (0~30V, 0~3A), and data acquisition

gBxgBygBz

−0.2

0.0

0.2

0.4

0.6

0.8

1.0

1.2

Estim

atio

n of

gyr

osco

pe b

ias (

°/h)

1000 300 400200 500t (s)

(a)

gSFxgSFy

100 200 300 4000 500t (s)

−50

0

50

100

150

200

250

300

350

Estim

atio

n of

gyr

osco

pe sc

ale f

acto

r (pp

m)

(b)

gMAxzgMAyxgMAyz

100 200 300 400 5000t (s)

−10

0

10

20

30

40

50

60

Estim

atio

n of

gyr

osco

pe m

isalig

nmen

t (”)

(c)

Figure 5: Estimation of gyroscope errors. (a) Estimation ofgyroscope bias. (b) Estimation of gyroscope scale factor.(c) Estimation of gyroscope misalignment.

9Journal of Sensors

Page 10: A Preferable Airborne Integrated Navigation Method Based ...downloads.hindawi.com/journals/js/2018/7342896.pdf · Research Article A Preferable Airborne Integrated Navigation Method

computer. Turntable is one of the important equipment intest for simulating the change of attitude and attitude rateof aircraft in space. INS/GPS integrated navigation systemconsists of inertial navigation system and GPS receiver. Theinstallation of the main test equipment is shown inFigures 8 and 9.

The error values of IMU are shown in Table 4.Based on the analysis of the typical airborne trajectory,

turntable is used to simulate the typical airborne movement.The rotation parameter of the turntable during the test isshown in Table 5.

The simulation time is 700 seconds, the first 500 secondsfor INS/GPS integrated navigation. Integrated system turnsinto inertial navigation mode after 500 seconds. The testresults are as follows, Figure 10 shows the estimation ofgyroscope bias, scale factor error, and misalignment errorin integrated navigation. Figure 11 shows the estimation ofaccelerometer bias, scale factor error, and misalignment errorin integrated navigation. Figure 12 shows the estimation ofposition error of the traditional integrated navigation modeland the proposed navigation model in the whole process,including the east position error, the north position error,and the upward position error.

From Figures 10–12, observable error estimation sta-tus of IMU in the integrated navigation process is shownin Table 6.

As can be seen from Table 6, there are 7 observable errorsof IMU of which the estimation accuracy is more than 80%.There are 4 observable errors of which the estimation accu-racy is between 50% and 80%, and there are 4 observableerrors between 20% and 50%. Consequently, most of theobservable errors of IMU are effectively estimated in theintegrated navigation process.

From the test results above, we can conclude that after500 seconds integrated navigation and 200 seconds inertialnavigation, the position errors of the east, north, and upwardof the traditional model are 798.3m, 550.6m, and 207m,respectively. The east, north, and upward position errors ofthe proposed integrated model are 592.2m, 444.8m, and176.6m, respectively. The navigation accuracy of the east,north, and upward positions of the proposed modelimproved by 25.8%, 19.2%, and 14.7%, respectively. Conse-quently, the integrated navigation method proposed in thispaper can achieve higher navigation accuracy. So the inte-grated navigation model proposed in this paper is superiorand effective.

5. Conclusions

The influence of scale factor error and misalignment error onnavigation accuracy is analyzed in this paper. Based on theanalysis, scale factor error and misalignment error are con-sidered in the error state vector. Then the observability ofscale factor error and misalignment error is analyzed com-bined with typical airborne movement. The integratedsystem is optimized according to the observability analysisresults. Finally, this method is verified by numerical simula-tion and turntable test. The results all show that the INS/GPS integrated navigation model proposed in this paper

aBxaByaBz

−100

0

100

200

300

400

500

600Es

timat

ion

of ac

cele

rom

eter

bia

s (�휇

g)

100 200 300 400 5000t (s)

(a)

aSFyaSFz

0

100

200

300

400

Estim

atio

n of

acce

lero

met

er sc

ale f

acto

r (”)

100 200 3000 500400t (s)

(b)

t (s)100 200 300 400 5000

0

10

20

30

40

50

Estim

atio

n of

acce

lero

met

er m

isalig

nmen

t (”)

aMAxyaMAzx

(c)

Figure 6: Estimation of accelerometer errors. (a) Estimation ofaccelerometer bias. (b) Estimation of accelerometer scale factor.(c) Estimation of accelerometer misalignment.

10 Journal of Sensors

Page 11: A Preferable Airborne Integrated Navigation Method Based ...downloads.hindawi.com/journals/js/2018/7342896.pdf · Research Article A Preferable Airborne Integrated Navigation Method

True valueProposed integrated model

0

5000

10000

15000

20000

25000Ea

st po

sitio

n (m

)

600 700300 400 500100 2000t (s)

(a)

True valueProposed integrated model

0

2000

4000

6000

8000

10000

12000

Nor

th p

ositi

on (m

)

600 700300 400 500100 2000t (s)

(b)

True valueProposed integrated model

0

500

1000

1500

2000

2500

Upw

ard

posit

ion

(m)

600 700300 400 500100 2000t (s)

(c)

Traditional integrated modelProposed integrated model

−50

0

50

100

150

200

250

300

350

400Ea

st po

sitio

n er

ror (

m)

600 700300 400 500100 2000t (s)

(d)

Traditional integrated modelProposed integrated model

−250

−200

−150

−100

−50

0

Nor

th p

ositi

on er

ror (

m)

600 700300 400 500100 2000t (s)

(e)

Traditional integrated modeProposed integrated model

−140

−120

−100

−80

−60

−40

−20

0

20

Upw

ard

posit

ion

erro

r (m

)

600 700300 400 500100 2000t (s)

(f)

Figure 7: Estimation of position. (a) Calculation of east position. (b) Calculation of north position. (c) Calculation of upward position.(d) Estimation of east position error. (e) Estimation of north position error. (f) Estimation of upward position error.

11Journal of Sensors

Page 12: A Preferable Airborne Integrated Navigation Method Based ...downloads.hindawi.com/journals/js/2018/7342896.pdf · Research Article A Preferable Airborne Integrated Navigation Method

gBxgBygBz

−0.4−0.2

0.00.20.40.60.81.01.21.4

Estim

atio

n of

gyr

osco

pe b

ias (

°/h)

0 200 300 400 500100t (s)

(a)

gSFxgSFy

100 200 300 4000 500t (s)

−50

0

50

100

150

200

250

300

350

Estim

atio

n of

gyr

osco

pe sc

ale f

acto

r (pp

m)

(b)

gMAxzgMAyxgMAyz

100 200 300 400 5000t (s)

−40

−20

0

20

40

60

80

Estim

atio

n of

gyr

osco

pe m

isalig

nmen

t (”)

(c)

Figure 10: Estimation of gyroscope errors. (a) Estimation ofgyroscope bias. (b) Estimation of gyroscope scale factor.(c) Estimation of gyroscope misalignment.

Table 5: Rotation parameter setting of turntable.

Time Dynamic situation Rate of rotation

0~20 Still

20~25 Pitch rotate 30° 6°/s

25~125 Still

125~130 Pitch rotate −30° −6°/s130~330 Still

330~350 Roll rotate 20° 1°/s

350~395 Yaw rotate 90° 2°/s

395~415 Roll rotate −20° −1°/s415~700 Still

Table 4: Error values of IMU.

Gyroscope errors

Bias 1°/h

Scale factor 300 ppm

Misalignment 40″Accelerometer errors

Bias 500μg

Scale factor 300 ppm

Misalignment 40″

Figure 9: Installation of the integrated system and GPS antenna.

Figure 8: Installation of the test equipment.

12 Journal of Sensors

Page 13: A Preferable Airborne Integrated Navigation Method Based ...downloads.hindawi.com/journals/js/2018/7342896.pdf · Research Article A Preferable Airborne Integrated Navigation Method

Traditional integrated modelProposed integrated model

−800

−600

−400

−200

0

East

posit

ion

erro

r (m

)

0 200 300 400 500 600 700100t (s)

(a)

Traditional integrated modeProposed integrated model

100 200 300 400 500 600 7000t (s)

0

100

200

300

400

500

600

Nor

th p

ositi

on er

ror (

m)

(b)

Traditional integrated modelProposed integrated model

−200

−150

−100

−50

0

Upw

ard

posit

ion

erro

r (m

)

100 200 300 400 500 600 7000t (s)

(c)

Figure 12: Estimation of position errors. (a) Estimation of theeast position error. (b) Estimation of the north position error.(c) Estimation of the upward position error.

aBxaByaBz

−400

−200

0

200

400

600

800

1000

1200Es

timat

ion

of ac

cele

rom

eter

bia

s (�휇

g)

0 200 300 400 500100t (s)

(a)

aSFyaSFz

−500

50100150200250300350400

Estim

atio

n of

acce

lero

met

er sc

ale f

acto

r (pp

m)

100 200 300 5000 400t (s)

(b)

aMAxyaMAzx

−10

−5

0

5

10

15

20

Estim

atio

n of

acce

lero

met

er m

isalig

nmen

t (”)

100 5000 400200 300t (s)

(c)

Figure 11: Estimation of accelerometer errors. (a) Estimation ofaccelerometer bias. (b) Estimation of accelerometer scale factor.(c) Estimation of accelerometer misalignment.

13Journal of Sensors

Page 14: A Preferable Airborne Integrated Navigation Method Based ...downloads.hindawi.com/journals/js/2018/7342896.pdf · Research Article A Preferable Airborne Integrated Navigation Method

can obtain more effective estimation of IMU errors thantraditional integrated navigation model. In addition, whenGPS becomes invalid, the proposed integrated model canachieve higher navigation accuracy.

Conflicts of Interest

The authors declare that there are no conflicts of interestregarding the publication of this paper.

References

[1] H. Han, J. Wang, and M. Du, “A fast SINS initialalignment method based on RTS forward and backwardresolution,” Journal of Sensors, vol. 2017, Article ID7161858, 11 pages, 2017.

[2] X. Wang andW. Ni, “An improved particle filter and its appli-cation to an INS/GPS integrated navigation system in a seriousnoisy scenario,”Measurement Science and Technology, vol. 27,no. 9, article 095005, 2016.

[3] G. Grunwald, M. Bakuła, A. Ciećko, and R. Kaźmierczak,“Examination of GPS/EGNOS integrity in north-easternPoland,” IET Radar, Sonar & Navigation, vol. 10, no. 1,pp. 114–121, 2016.

[4] Y. Li, G. Sun, and W. Jiang, GPS/BeiDou/INS Performance inTwo Hemispheres, Inside GNSS, NJ, USA, 2013.

[5] R. T. Kelley, N. A. Carlson, and S. Berning, “Integrated inertialnetwork,” in Proceedings of 1994 IEEE Position, Location andNavigation Symposium - PLANS'94, pp. 439–446, Las Vegas,NV, USA, April 1994.

[6] R. H. Liu and L. Z. Liang, “Status and prospect of INS/CNS/GNSS integrated navigation technology,” Modern Navigation,vol. 28, no. 6, pp. 62–65, 2014.

[7] H. J. Lei and Y. C. Zhang, Review of Airborne Inertial Naviga-tion Technology, Xi’an Flight Automatic Control ResearchInstitute, Xi’an, China, 2016.

[8] Y. Bai, Q. Sun, L. Du, M. Yu, and J. Bai, “Two laboratorymethods for the calibration of GPS speed meters,” Measure-ment Science and Technology, vol. 26, no. 1, article 015005,2015.

[9] S. Han and J. Wang, “Land vehicle navigation with the integra-tion of GPS and reduced INS: performance improvement withvelocity aiding,” The Journal of Navigation, vol. 63, no. 1,pp. 153–166, 2010.

[10] S. Han and J. Wang, “A novel initial alignment scheme forlow-cost INS aided by GPS for land vehicle applications,”The Journal of Navigation, vol. 63, no. 4, pp. 663–680, 2010.

[11] H. Peng, Z. Xiong, R. Wang, J. Liu, and J. Wang, “Dynamicparameter identification research on the installation errorsand the scale factor errors of the IMU,” Chinese Space Scienceand Technology, vol. 34, no. 1, pp. 42–49, 2014.

[12] G. Zhou, J. Wang, and K. Li, “Analysis of singular value underKalman filtering for strapdown inertial system online calibra-tion,” in Lecture Notes in Electrical Engineering, pp. 779–784,Springer, Berlin, Heidelberg, 2011.

[13] Y. Y. Qin, Inertial Navigation, Science Press, Beijing, China,2015.

[14] X. Zhang, H. Shi, and C. Zhang, “Integrated navigationmethod based on inertial navigation system and Lidar,” Opti-cal Engineering, vol. 55, no. 4, article 044102, 2016.

[15] X. L. Wang and Y. F. Li, SINS/GPS Integrated Navigation Tech-nology, Beihang University Press, Beijing, China, 2014.

[16] H. N. Wang, Principles and Applications of GPS Navigation,Science Press, Beijing, China, 2003.

[17] Q. Wang, W. Gao, M. Diao, F. Yu, and Y. Li, “Coarse align-ment of a shipborne strapdown inertial navigation systemusing star sensor,” IET Science, Measurement & Technology,vol. 9, pp. 852–820, 2016.

[18] W. Feng and J. Wang, “Design and implementation of flighttrack simulation system,” Computer Simulation, vol. 12,pp. 47–50, 2010.

[19] F. Xu, J. C. Fang, and W. Quan, “Hardware in-the-loop simu-lation of SINS/CNS/GPS integrated navigation system,” Jour-nal of System Simulation, vol. 20, no. 2, pp. 332–385, 2008.

Table 6: Observable error estimation status of IMU.

Observable error Test value Estimated valueAccuracy ofestimation

gBx 1°/h 1.1°/h 91%

gBy 1°/h 1.1°/h 91%

gBz 1°/h 0.5°/h 50%

gSFx 300 ppm 327 ppm 90%

gSFy 300 ppm 214 ppm 71%

gMAxz 40″ 51″ 78%

gMAyx 40″ 38″ 95%

gMAyz 40″ −43″ 93%

aBx 500μg 602μg 83%

aBy 500μg 702μg 71%

aBz 500μg 107μg 21%

gSFy 300 ppm 369 ppm 81%

gSFz 300 ppm 62 ppm 21%

aMAxy 40″ 13″ 33%

aMAzx 40″ −8″ 20%

14 Journal of Sensors

Page 15: A Preferable Airborne Integrated Navigation Method Based ...downloads.hindawi.com/journals/js/2018/7342896.pdf · Research Article A Preferable Airborne Integrated Navigation Method

International Journal of

AerospaceEngineeringHindawiwww.hindawi.com Volume 2018

RoboticsJournal of

Hindawiwww.hindawi.com Volume 2018

Hindawiwww.hindawi.com Volume 2018

Active and Passive Electronic Components

VLSI Design

Hindawiwww.hindawi.com Volume 2018

Hindawiwww.hindawi.com Volume 2018

Shock and Vibration

Hindawiwww.hindawi.com Volume 2018

Civil EngineeringAdvances in

Acoustics and VibrationAdvances in

Hindawiwww.hindawi.com Volume 2018

Hindawiwww.hindawi.com Volume 2018

Electrical and Computer Engineering

Journal of

Advances inOptoElectronics

Hindawiwww.hindawi.com

Volume 2018

Hindawi Publishing Corporation http://www.hindawi.com Volume 2013Hindawiwww.hindawi.com

The Scientific World Journal

Volume 2018

Control Scienceand Engineering

Journal of

Hindawiwww.hindawi.com Volume 2018

Hindawiwww.hindawi.com

Journal ofEngineeringVolume 2018

SensorsJournal of

Hindawiwww.hindawi.com Volume 2018

International Journal of

RotatingMachinery

Hindawiwww.hindawi.com Volume 2018

Modelling &Simulationin EngineeringHindawiwww.hindawi.com Volume 2018

Hindawiwww.hindawi.com Volume 2018

Chemical EngineeringInternational Journal of Antennas and

Propagation

International Journal of

Hindawiwww.hindawi.com Volume 2018

Hindawiwww.hindawi.com Volume 2018

Navigation and Observation

International Journal of

Hindawi

www.hindawi.com Volume 2018

Advances in

Multimedia

Submit your manuscripts atwww.hindawi.com