6
Research Article Study on a Twice Transfer Alignment Based on Dual Model Shuai Chen, 1 Runwu Zhong, 1 Xiaohui Liu, 2,3 and Ahmed Alsaedi 4 1 School of Automation, Nanjing University of Science and Technology, Nanjing 210094, China 2 Department of Computer Science, Brunel University, Uxbridge, Middlesex UB8 3PH, UK 3 Faculty of Engineering, King Abdulaziz University, Jeddah 21589, Saudi Arabia 4 Nonlinear Analysis and Applied Mathematics (NAAM) Research Group, Department of Mathematics, Faculty of Science, King Abdulaziz University, Jeddah 21589, Saudi Arabia Correspondence should be addressed to Shuai Chen; [email protected] Received 29 October 2014; Revised 11 December 2014; Accepted 28 December 2014 Academic Editor: Zidong Wang Copyright © 2015 Shuai Chen et al. is 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. is paper proposes a twice rapid transfer alignment algorithm based on dual models in order to solve the problems such as long convergence time, poor accuracy, and heavy computation burden resulting from the traditional nonlinear error models. e quaternion matching method based on quaternion error model along with the extended Kalman filter (EKF) is applied to deal with the large misalignment in the first phase. en in the second transfer alignment phase, velocity plus attitude matching method as well as classical Kalman filter is adopted. e simulation and the results of vehicle tests demonstrate that this method combines the advantages of both nonlinear and linear error models with the guarantee of accuracy and fastness. 1. Introduction e technology of rapid transfer alignment for inertial navi- gation system with small attitude errors has been adequately studied in theoretical research and widely applied in engi- neering practice, satisfying the requirements of rapidity and high degree of accuracy [1]. However, the model is highly dependent on the small misalignment angles assumption and therefore is not applicable under the situation when the attitude errors become large. In this case, the traditional linear error model cannot accurately describe the error propagation characteristics of the inertial navigation system, which will inevitably degrade the performance of the filter, and some- times even lead to instability and divergence. Consequently, some researchers studied the nonlinear error models [26] and proposed various kinds of nonlinear Kalman filters [711]. However, the state estimation of nonlinear error model has poor performance and a huge computing burden which requires a long time to converge. Hence, it cannot meet the requirements of stability and fastness. Obviously both of the two models have their own short- comings. In this paper, we aim to find a transfer alignment algorithm appropriate for arbitrary misalignment angles, which has the advantages of fast convergent rate and high accuracy. A twice transfer alignment algorithm based on dual models is proposed in this paper, which combines the advantages of both nonlinear and linear error models. (A) Model Based on Additive Quaternion. e models are composed of the velocity error and the quaternion error propagation model, where the state variables can be presented as = [ V ∇], (1) where = [ 1 2 3 4 ] is the quaternion error vector; V = [V V V ] indicates velocity vector with respect to Earth in the navigation frame; = [ ] and ∇ = [∇ ] are equivalent gyrodriſt vector and equivalent accelerometer bias vector, respectively, in the body frame. e quaternion is widely used as an effective method to compute the attitude of INS (inertial navigation system). According to the relationship between quaternion errors and tilt angle, quaternion errors can be used to describe Hindawi Publishing Corporation Discrete Dynamics in Nature and Society Volume 2015, Article ID 943065, 5 pages http://dx.doi.org/10.1155/2015/943065

Research Article Study on a Twice Transfer Alignment Based ...Research Article Study on a Twice Transfer Alignment Based on Dual Model ShuaiChen, 1 RunwuZhong, 1 XiaohuiLiu, 2,3 andAhmedAlsaedi

  • Upload
    others

  • View
    2

  • Download
    0

Embed Size (px)

Citation preview

Page 1: Research Article Study on a Twice Transfer Alignment Based ...Research Article Study on a Twice Transfer Alignment Based on Dual Model ShuaiChen, 1 RunwuZhong, 1 XiaohuiLiu, 2,3 andAhmedAlsaedi

Research ArticleStudy on a Twice Transfer Alignment Based on Dual Model

Shuai Chen1 Runwu Zhong1 Xiaohui Liu23 and Ahmed Alsaedi4

1School of Automation Nanjing University of Science and Technology Nanjing 210094 China2Department of Computer Science Brunel University Uxbridge Middlesex UB8 3PH UK3Faculty of Engineering King Abdulaziz University Jeddah 21589 Saudi Arabia4Nonlinear Analysis and Applied Mathematics (NAAM) Research Group Department of Mathematics Faculty of ScienceKing Abdulaziz University Jeddah 21589 Saudi Arabia

Correspondence should be addressed to Shuai Chen c1492163com

Received 29 October 2014 Revised 11 December 2014 Accepted 28 December 2014

Academic Editor Zidong Wang

Copyright copy 2015 Shuai Chen et al This is an open access article distributed under the Creative Commons Attribution Licensewhich permits unrestricted use distribution and reproduction in any medium provided the original work is properly cited

This paper proposes a twice rapid transfer alignment algorithm based on dual models in order to solve the problems such aslong convergence time poor accuracy and heavy computation burden resulting from the traditional nonlinear error models Thequaternionmatching method based on quaternion error model along with the extended Kalman filter (EKF) is applied to deal withthe large misalignment in the first phase Then in the second transfer alignment phase velocity plus attitude matching method aswell as classical Kalman filter is adoptedThe simulation and the results of vehicle tests demonstrate that this method combines theadvantages of both nonlinear and linear error models with the guarantee of accuracy and fastness

1 Introduction

The technology of rapid transfer alignment for inertial navi-gation system with small attitude errors has been adequatelystudied in theoretical research and widely applied in engi-neering practice satisfying the requirements of rapidity andhigh degree of accuracy [1] However the model is highlydependent on the small misalignment angles assumptionand therefore is not applicable under the situation when theattitude errors become large In this case the traditional linearerrormodel cannot accurately describe the error propagationcharacteristics of the inertial navigation system which willinevitably degrade the performance of the filter and some-times even lead to instability and divergence Consequentlysome researchers studied the nonlinear error models [2ndash6]and proposed various kinds of nonlinear Kalman filters [7ndash11] However the state estimation of nonlinear error modelhas poor performance and a huge computing burden whichrequires a long time to converge Hence it cannot meet therequirements of stability and fastness

Obviously both of the two models have their own short-comings In this paper we aim to find a transfer alignmentalgorithm appropriate for arbitrary misalignment angles

which has the advantages of fast convergent rate and highaccuracy A twice transfer alignment algorithm based ondual models is proposed in this paper which combines theadvantages of both nonlinear and linear error models

(A) Model Based on Additive Quaternion The models arecomposed of the velocity error and the quaternion errorpropagationmodel where the state variables can be presentedas

119909 = [120575119902 120575V 120576 nabla] (1)

where 120575119902 = [1205751199021120575119902212057511990231205751199024] is the quaternion error

vector 120575V = [120575V119890 120575V119899 120575V119906] indicates velocity vector with

respect to Earth in the navigation frame 120576 = [120576119909120576119910120576119911]

and nabla = [nabla119909nabla119910nabla119911] are equivalent gyrodrift vector and

equivalent accelerometer bias vector respectively in the bodyframe

The quaternion is widely used as an effective methodto compute the attitude of INS (inertial navigation system)According to the relationship between quaternion errorsand tilt angle quaternion errors can be used to describe

Hindawi Publishing CorporationDiscrete Dynamics in Nature and SocietyVolume 2015 Article ID 943065 5 pageshttpdxdoiorg1011552015943065

2 Discrete Dynamics in Nature and Society

the attitude error The quaternion and velocity error differ-ential equation can be given as follows

120575 =

1

2

119872120575 119876 +

1

2

119880 (120576119887+119882119887

119892) minus

1

2

119884120575120596119899

119894119899

120575V119899 = minus2 [1006704119862119899119904

1006704119891119887] times 119884119879120575 119876 + 21006704119862

119899

119904

1006704119891119887119876119879120575 119876

minus 1198841198791198801006704119891119887+ 1006704119862119899

119904nabla119887minus (2120596

119899

119894119890+ 120596119899

119890119899) times 120575V119899

minus (2120596119899

119894119890+ 120596119899

119890119899) times V119899

(2)

where 120575 119876 is the quaternion error vector120596119899119894119899= [120596119864

120596119873

120596119880]

is the rotation rate of the navigation frame with respect tothe inertial frame defined in the navigation frame 120596119887

119894119887=

[120596119909120596119910120596119911] represents the rotational angular velocity of

SINS (Slave Inertial Navigation System) with respect to theinertial frame defined in the SINS body frame the matrices119880 119884 and119872 can be presented as follows

119880 =

[

[

[

[

[

[

minus1199021minus1199022minus1199023

1199020

minus1199023

1199022

1199023

1199020

minus1199021

minus1199022

1199021

1199020

]

]

]

]

]

]

119884 =

[

[

[

[

[

[

minus1199021minus1199022minus1199023

1199020

1199023

minus1199022

minus1199023

1199020

1199021

1199022

minus1199021

1199020

]

]

]

]

]

]

119872 =

[

[

[

[

[

[

0 120596119864minus 120596119909

120596119873minus 120596119910

120596119880minus 120596119911

120596119909minus 120596119864

0 120596119911+ 120596119880

minus120596119910minus 120596119873

120596119910minus 120596119873

minus120596119911minus 120596119880

0 120596119909+ 120596119864

120596119911minus 120596119880

120596119910+ 120596119873

minus120596119909minus 120596119864

0

]

]

]

]

]

]

(3)

1006704119862119899

119904is the indicated transformation matrix of SINS from the

body frame to the navigation frame 1006704119891119887 indicates specific

force of SINS in its body frame 120596119899119894119890is the rotation rate of

the Earth with respect to the inertial frame defined in thenavigation frame 120596119899

119890119899is the turn rotational angular velocity

of the navigation frame with respect to the Earth V119899 =

[V119890 V119899

V119906] indicates velocity vector of SINS with respect to

Earth in the navigation frame 119884119879119880 1006704119891119887 is the nonlinear term

in the equation of velocity error

(B) Model of Rapid Transfer Alignment This model waspresented by Kain and Cloutier in [1] The state variables arepresented as

119909 = [120593119899120575V119899 120576

119894nabla119894120582119894] (4)

where 120593 = [120593119909120593119910120593119911] is defined as the rotation vector

error between the true navigation frame 119899 and the indicated

navigation frame 1198991015840 If 120593 is sufficiently small the state

equation can be expressed as follows

120575119899= 119891119899times 120593119899minus (2120575120596

119899

119894119890+ 120575120596119899

119890119899) times 119881119899

minus (2120596119899

119894119890+ 120596119899

119890119899) times 120575119881

119899+ 119862119899

119887nabla119894

119899= minus120596119899

119894119899times 120593119899+ 120575120596119899

119894119899+ 119862119899

119887120576119894

120576119894= 0 nabla

119894= 0

120577119894= 0

(5)

where 120593119899 and 120575119881119899 are the attitude error and velocity error

vectors respectively 119881119899 indicates velocity vector in thenavigation frame119891119899 indicates specific force in the navigationframe 120596119899

119894119890is the Earth rate vector 120596119899

119890119899is the turn rate of

the navigation frame with respect to the Earth 119862119899119887is the

direction cosine matrix of SINS 120576119894and nabla

119894(119894 = 119909 119910 119911) are

equivalent gyrodrift vector and equivalent accelerometer biasvector respectively in the body frame 120577

119894(119894 = 119909 119910 119911) is 3-axis

component of INS installation error angle vector in the bodyframe

(C) Transfer Alignment Based on Dual Model By a largeamount of simulation tests we find out that attitude errorcan quickly converge to small angles when the error modelbased on quaternion is used under the condition of largemisalignment angle However it still takes a long time toconverge to a satisfactory accuracy In this case we intend toswitch to the linear model to obtain faster convergence speedand higher accuracy This approach is called a twice transferalignment based on dual model This method uses nonlinearmodel in first phase Then after the estimation of attitudeerror converging to small angles the linear error model isadopted to complete the twice transfer alignment

2 Experimental Results

21 Simulation and Results The simulation is performedin two different cases In Case A model based quaternionand EKF which is easily realized in engineering project areadopted in the first phase Through analyzing the perfor-mance of the nonlinear system by simulation experimentsthe time point to switch to linear error model and classicalKalman filter in the next stage is decided at the 10th secondIn Case B model based additive quaternion and EKF areutilized The initial attitude errors in roll pitch and headingare all assumed to be 20∘ The total time of the simulation is60 s the initial position is set at 325 degrees north latitude135 degrees east longitude 500 meters height the initialattitudes are all set at 0∘ the initial north velocity is 50mseast and vertical velocities are 0ms The constant gyrodriftsand accelerometer biases are set at 10∘h 5mg respectivelyThe simulation results are shown in Figures 1-2 and Table 1

Figure 1 shows the alignment results in the first phaseThefigures indicate that the attitude estimation error gets wellinto the range of the ideal accuracy during the first 10 s Afterthe calibration is done the conventional transfer alignmentprocess will work well in the following 50 s

Figure 2 andTable 1 compare the attitude estimation errorin Case Awith that in Case B It is clear that the red curves not

Discrete Dynamics in Nature and Society 3

0 2 4 6 8 10

0

5

Time (s)

Pitch estimation error

Case A Case B

6 8 10

0

minus25

minus20

minus15

minus10

minus5

minus05

05

(∘)

(a)

0 2 4 6 8 10Time (s)

Roll estimation error

0

5

Case A Case B

minus20

minus15

minus10

minus5

minus02

minus04

02(∘)

0

6 8 10

(b)

Yaw estimation error

0 2 4 6 8 10

0

Time (s)

Case A Case B

6 8 10

minus25

minus20

minus15

minus10

minus5

minus06

minus08

minus1

(∘)

(c)

Figure 1 The attitude estimation error of first phase

Table 1 Alignment accuracy comparison

Estimated error of attitude (∘)Pitch Roll Yaw

Case A 0002 0001 0005Case B 012 022 018

only have higher rate of convergence but also are smootherthan blue curves In particular the red curves all convergewithin 0005∘ Instead the blue curves fluctuate within arange of 022∘ The results show that the dual model has

obviously a faster convergent speed and higher accuracy thanthat in Case B

22 Vehicle Test and Results In order to verify the perfor-mance of the proposed algorithm vehicle tests are conducted[12ndash14] The test configuration is illustrated in Figure 3 Aslab and four steel dowels are machined which could beused to artificially misalign the SINS from the MINS (MasterInertialNavigation System) in pitch roll and yaw In practicalengineering the model based additive quaternion is difficultto establish However if the rough misalignment is knownthe attitude of SINS can be calibrated directly and the first

4 Discrete Dynamics in Nature and Society

10 15 20 25 30 35 40 45 50 55 60Time (s)

Pitch estimation error

Case A Case B

(∘)

minus07

minus06

minus05

minus04

minus03

minus02

minus01

0

01

02

03

(a)

10 15 20 25 30 35 40 45 50 55 60Time (s)

minus05

minus04

minus03

minus02

minus01

0

01

02

03Roll estimation error

Case A Case B

(∘)

(b)

10 15 20 25 30 35 40 45 50 55 60Time (s)

minus1

minus08

minus06

minus04

minus02

0

02

Yaw estimation error

Case A Case B

(∘)

(c)

Figure 2 The attitude estimation error of second phase

Figure 3 SINS and MINS of the vehicle test

phase can be skippedwhichmeans a twice transfer alignmentcan be directly conducted with the rough misalignment Theperformance of transfer alignment is assessed with differentassumed misalignments Figure 4 illustrates the alignmentresults

In Figure 3 the SINS and MINS are bolted to the slab inthe test The steel dowels are used to establish misalignmentsin three axes intentionally In the test the misalignmentsin pitch roll and yaw are set at about 10∘ 0∘ and 33∘respectively The positive roll and return-to-level maneuveris adopted in tests which can be called wing-rock maneuverOnce transfer alignment begins one end of the slab ismanually tilted up and set back down in the vehicle

Discrete Dynamics in Nature and Society 5

0 20 40 60 80 100

Estimated attitude misalignment

t (s)

95

10

105

11

Pitc

h m

isalig

nmen

t(∘)

(a)

0 20 40 60 80 100t (s)

minus1

minus05

0

05

Roll

misa

lignm

ent

(∘)

(b)

0 20 40 60 80 100t (s)

32

33

34

Yaw

misa

lignm

ent

(∘)

(105∘ 0∘ 33∘)(105∘ 0∘ 335∘)(10∘ 0∘ 33∘)

(c)

Figure 4 Curve of the vehicle results

Figure 4 compares the estimated attitude misalignmentsin three axes when the assumed misalignments used tocalibrate attitude of SINS are different In the figure attitudemisalignments are accurately estimated in spite of the factthat the assumed misalignments are different The deviationof the estimated value is less than 01∘

3 Conclusion

In order to satisfy the requirements of rapidity and highaccuracy in transfer alignmentwith large uncertainty a trans-fer alignment algorithm based on dual model is presentedThe simulation and vehicle test results demonstrate that thismethod could combine the advantages of nonlinear andlinear error models which not only can be used in inertialnavigation system with large uncertainty but also has thesame high accuracy as the linear system

Conflict of Interests

The authors declare that there is no conflict of interestsregarding the publication of this paper

Acknowledgments

This work was supported by NSAF (Grant no U1330133) andthe Natural Science Foundation of Jiangsu Province (GrantBK20130774)

References

[1] J Kain and J Cloutier ldquoRapid transfer alignment for tacticalweapon applicationsrdquo AIAA Paper 89-3581 The AmericanInstitute of Aeronautics and Astronautics 1989

[2] Y Luo G Wei X Ding and Y Liu ldquoController design for 2-D stochastic nonlinear Roesser model a probability-dependentgain-scheduling approachrdquo Journal of the Franklin Institute vol351 no 11 pp 5182ndash5203 2014

[3] H Hong J Lee and G Park ldquoIn-flight alignment of SDINSunder large initial heading errorrdquo in Proceedings of the AIAAGuidance Navigation and Control Conference and ExhibitAIAA Paper 2001-4183 Montreal Canada August 2001

[4] L Wang G Wei and W Li ldquoProbability-dependent 119867infin

synchronization control for dynamical networkswith randomlyvarying nonlinearitiesrdquo Neurocomputing vol 133 pp 369ndash3762014

[5] L Wang G Wei and H Shu ldquoState estimation for complexnetworks with randomly occurring coupling delaysrdquo Neuro-computing vol 122 pp 513ndash520 2013

[6] J Liang F Sun and X Liu ldquoFinite-horizon 119867infin

filteringfor time-varying delay systems with randomly varying non-linearities and sensor saturationsrdquo Systems Science amp ControlEngineering vol 2 no 1 pp 108ndash118 2014

[7] A Ghanbari and M Moghanni-Bavil-Olyaei ldquoAdaptive fuzzyterminal sliding-mode control of MEMS z-axis gyroscope withextended Kalman filter observerrdquo Systems Science and ControlEngineering vol 2 no 1 pp 183ndash191 2014

[8] M Darouach and H S Ali ldquoOptimal unbiased functionalfiltering in the frequency domainrdquo Systems Science amp ControlEngineering vol 2 no 1 pp 308ndash315 2014

[9] D Ding Z Wang J Hu and H Shu ldquoDissipative control forstate-saturated discrete time-varying systems with randomlyoccurring nonlinearities and missing measurementsrdquo Interna-tional Journal of Control vol 86 no 4 pp 674ndash688 2013

[10] J Hu Z Wang H Gao and L K Stergioulas ldquoProbability-guaranteed 119867

infinfinite-horizon filtering for a class of nonlinear

time-varying systems with sensor saturationsrdquo Systems andControl Letters vol 61 no 4 pp 477ndash484 2012

[11] S J Julier J K Uhlmann and H F Durrant-Whyte ldquoA newapproach for filtering nonlinear systemsrdquo in Proceedings ofthe American Control Conference vol 3 pp 1628ndash1632 IEEESeattle Wash USA Jun 1995

[12] K J Shortelle W R Graham and C Rabourn ldquoF-16 flight testsof a rapid transfer alignment procedurerdquo in Proceedings of thIEEEPosition Location andNavigation Symposium pp 379ndash386IEEE Palm Springs Calif USA April 1998

[13] B Shen Z Wang H Shu and G Wei ldquoRobust 119867infin

finite-horizon filtering with randomly occurred nonlinearities andquantization effectsrdquo Automatica vol 46 no 11 pp 1743ndash17512010

[14] H Dong Z Wang J Lam and H Gao ldquoDistributed filteringin sensor networks with randomly occurring saturations andsuccessive packet dropoutsrdquo International Journal of Robust andNonlinear Control vol 24 no 12 pp 1743ndash1759 2014

Submit your manuscripts athttpwwwhindawicom

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

MathematicsJournal of

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Mathematical Problems in Engineering

Hindawi Publishing Corporationhttpwwwhindawicom

Differential EquationsInternational Journal of

Volume 2014

Applied MathematicsJournal of

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Probability and StatisticsHindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Journal of

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Mathematical PhysicsAdvances in

Complex AnalysisJournal of

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

OptimizationJournal of

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

CombinatoricsHindawi Publishing Corporationhttpwwwhindawicom Volume 2014

International Journal of

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Operations ResearchAdvances in

Journal of

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Function Spaces

Abstract and Applied AnalysisHindawi Publishing Corporationhttpwwwhindawicom Volume 2014

International Journal of Mathematics and Mathematical Sciences

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

The Scientific World JournalHindawi Publishing Corporation httpwwwhindawicom Volume 2014

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Algebra

Discrete Dynamics in Nature and Society

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Decision SciencesAdvances in

Discrete MathematicsJournal of

Hindawi Publishing Corporationhttpwwwhindawicom

Volume 2014 Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Stochastic AnalysisInternational Journal of

Page 2: Research Article Study on a Twice Transfer Alignment Based ...Research Article Study on a Twice Transfer Alignment Based on Dual Model ShuaiChen, 1 RunwuZhong, 1 XiaohuiLiu, 2,3 andAhmedAlsaedi

2 Discrete Dynamics in Nature and Society

the attitude error The quaternion and velocity error differ-ential equation can be given as follows

120575 =

1

2

119872120575 119876 +

1

2

119880 (120576119887+119882119887

119892) minus

1

2

119884120575120596119899

119894119899

120575V119899 = minus2 [1006704119862119899119904

1006704119891119887] times 119884119879120575 119876 + 21006704119862

119899

119904

1006704119891119887119876119879120575 119876

minus 1198841198791198801006704119891119887+ 1006704119862119899

119904nabla119887minus (2120596

119899

119894119890+ 120596119899

119890119899) times 120575V119899

minus (2120596119899

119894119890+ 120596119899

119890119899) times V119899

(2)

where 120575 119876 is the quaternion error vector120596119899119894119899= [120596119864

120596119873

120596119880]

is the rotation rate of the navigation frame with respect tothe inertial frame defined in the navigation frame 120596119887

119894119887=

[120596119909120596119910120596119911] represents the rotational angular velocity of

SINS (Slave Inertial Navigation System) with respect to theinertial frame defined in the SINS body frame the matrices119880 119884 and119872 can be presented as follows

119880 =

[

[

[

[

[

[

minus1199021minus1199022minus1199023

1199020

minus1199023

1199022

1199023

1199020

minus1199021

minus1199022

1199021

1199020

]

]

]

]

]

]

119884 =

[

[

[

[

[

[

minus1199021minus1199022minus1199023

1199020

1199023

minus1199022

minus1199023

1199020

1199021

1199022

minus1199021

1199020

]

]

]

]

]

]

119872 =

[

[

[

[

[

[

0 120596119864minus 120596119909

120596119873minus 120596119910

120596119880minus 120596119911

120596119909minus 120596119864

0 120596119911+ 120596119880

minus120596119910minus 120596119873

120596119910minus 120596119873

minus120596119911minus 120596119880

0 120596119909+ 120596119864

120596119911minus 120596119880

120596119910+ 120596119873

minus120596119909minus 120596119864

0

]

]

]

]

]

]

(3)

1006704119862119899

119904is the indicated transformation matrix of SINS from the

body frame to the navigation frame 1006704119891119887 indicates specific

force of SINS in its body frame 120596119899119894119890is the rotation rate of

the Earth with respect to the inertial frame defined in thenavigation frame 120596119899

119890119899is the turn rotational angular velocity

of the navigation frame with respect to the Earth V119899 =

[V119890 V119899

V119906] indicates velocity vector of SINS with respect to

Earth in the navigation frame 119884119879119880 1006704119891119887 is the nonlinear term

in the equation of velocity error

(B) Model of Rapid Transfer Alignment This model waspresented by Kain and Cloutier in [1] The state variables arepresented as

119909 = [120593119899120575V119899 120576

119894nabla119894120582119894] (4)

where 120593 = [120593119909120593119910120593119911] is defined as the rotation vector

error between the true navigation frame 119899 and the indicated

navigation frame 1198991015840 If 120593 is sufficiently small the state

equation can be expressed as follows

120575119899= 119891119899times 120593119899minus (2120575120596

119899

119894119890+ 120575120596119899

119890119899) times 119881119899

minus (2120596119899

119894119890+ 120596119899

119890119899) times 120575119881

119899+ 119862119899

119887nabla119894

119899= minus120596119899

119894119899times 120593119899+ 120575120596119899

119894119899+ 119862119899

119887120576119894

120576119894= 0 nabla

119894= 0

120577119894= 0

(5)

where 120593119899 and 120575119881119899 are the attitude error and velocity error

vectors respectively 119881119899 indicates velocity vector in thenavigation frame119891119899 indicates specific force in the navigationframe 120596119899

119894119890is the Earth rate vector 120596119899

119890119899is the turn rate of

the navigation frame with respect to the Earth 119862119899119887is the

direction cosine matrix of SINS 120576119894and nabla

119894(119894 = 119909 119910 119911) are

equivalent gyrodrift vector and equivalent accelerometer biasvector respectively in the body frame 120577

119894(119894 = 119909 119910 119911) is 3-axis

component of INS installation error angle vector in the bodyframe

(C) Transfer Alignment Based on Dual Model By a largeamount of simulation tests we find out that attitude errorcan quickly converge to small angles when the error modelbased on quaternion is used under the condition of largemisalignment angle However it still takes a long time toconverge to a satisfactory accuracy In this case we intend toswitch to the linear model to obtain faster convergence speedand higher accuracy This approach is called a twice transferalignment based on dual model This method uses nonlinearmodel in first phase Then after the estimation of attitudeerror converging to small angles the linear error model isadopted to complete the twice transfer alignment

2 Experimental Results

21 Simulation and Results The simulation is performedin two different cases In Case A model based quaternionand EKF which is easily realized in engineering project areadopted in the first phase Through analyzing the perfor-mance of the nonlinear system by simulation experimentsthe time point to switch to linear error model and classicalKalman filter in the next stage is decided at the 10th secondIn Case B model based additive quaternion and EKF areutilized The initial attitude errors in roll pitch and headingare all assumed to be 20∘ The total time of the simulation is60 s the initial position is set at 325 degrees north latitude135 degrees east longitude 500 meters height the initialattitudes are all set at 0∘ the initial north velocity is 50mseast and vertical velocities are 0ms The constant gyrodriftsand accelerometer biases are set at 10∘h 5mg respectivelyThe simulation results are shown in Figures 1-2 and Table 1

Figure 1 shows the alignment results in the first phaseThefigures indicate that the attitude estimation error gets wellinto the range of the ideal accuracy during the first 10 s Afterthe calibration is done the conventional transfer alignmentprocess will work well in the following 50 s

Figure 2 andTable 1 compare the attitude estimation errorin Case Awith that in Case B It is clear that the red curves not

Discrete Dynamics in Nature and Society 3

0 2 4 6 8 10

0

5

Time (s)

Pitch estimation error

Case A Case B

6 8 10

0

minus25

minus20

minus15

minus10

minus5

minus05

05

(∘)

(a)

0 2 4 6 8 10Time (s)

Roll estimation error

0

5

Case A Case B

minus20

minus15

minus10

minus5

minus02

minus04

02(∘)

0

6 8 10

(b)

Yaw estimation error

0 2 4 6 8 10

0

Time (s)

Case A Case B

6 8 10

minus25

minus20

minus15

minus10

minus5

minus06

minus08

minus1

(∘)

(c)

Figure 1 The attitude estimation error of first phase

Table 1 Alignment accuracy comparison

Estimated error of attitude (∘)Pitch Roll Yaw

Case A 0002 0001 0005Case B 012 022 018

only have higher rate of convergence but also are smootherthan blue curves In particular the red curves all convergewithin 0005∘ Instead the blue curves fluctuate within arange of 022∘ The results show that the dual model has

obviously a faster convergent speed and higher accuracy thanthat in Case B

22 Vehicle Test and Results In order to verify the perfor-mance of the proposed algorithm vehicle tests are conducted[12ndash14] The test configuration is illustrated in Figure 3 Aslab and four steel dowels are machined which could beused to artificially misalign the SINS from the MINS (MasterInertialNavigation System) in pitch roll and yaw In practicalengineering the model based additive quaternion is difficultto establish However if the rough misalignment is knownthe attitude of SINS can be calibrated directly and the first

4 Discrete Dynamics in Nature and Society

10 15 20 25 30 35 40 45 50 55 60Time (s)

Pitch estimation error

Case A Case B

(∘)

minus07

minus06

minus05

minus04

minus03

minus02

minus01

0

01

02

03

(a)

10 15 20 25 30 35 40 45 50 55 60Time (s)

minus05

minus04

minus03

minus02

minus01

0

01

02

03Roll estimation error

Case A Case B

(∘)

(b)

10 15 20 25 30 35 40 45 50 55 60Time (s)

minus1

minus08

minus06

minus04

minus02

0

02

Yaw estimation error

Case A Case B

(∘)

(c)

Figure 2 The attitude estimation error of second phase

Figure 3 SINS and MINS of the vehicle test

phase can be skippedwhichmeans a twice transfer alignmentcan be directly conducted with the rough misalignment Theperformance of transfer alignment is assessed with differentassumed misalignments Figure 4 illustrates the alignmentresults

In Figure 3 the SINS and MINS are bolted to the slab inthe test The steel dowels are used to establish misalignmentsin three axes intentionally In the test the misalignmentsin pitch roll and yaw are set at about 10∘ 0∘ and 33∘respectively The positive roll and return-to-level maneuveris adopted in tests which can be called wing-rock maneuverOnce transfer alignment begins one end of the slab ismanually tilted up and set back down in the vehicle

Discrete Dynamics in Nature and Society 5

0 20 40 60 80 100

Estimated attitude misalignment

t (s)

95

10

105

11

Pitc

h m

isalig

nmen

t(∘)

(a)

0 20 40 60 80 100t (s)

minus1

minus05

0

05

Roll

misa

lignm

ent

(∘)

(b)

0 20 40 60 80 100t (s)

32

33

34

Yaw

misa

lignm

ent

(∘)

(105∘ 0∘ 33∘)(105∘ 0∘ 335∘)(10∘ 0∘ 33∘)

(c)

Figure 4 Curve of the vehicle results

Figure 4 compares the estimated attitude misalignmentsin three axes when the assumed misalignments used tocalibrate attitude of SINS are different In the figure attitudemisalignments are accurately estimated in spite of the factthat the assumed misalignments are different The deviationof the estimated value is less than 01∘

3 Conclusion

In order to satisfy the requirements of rapidity and highaccuracy in transfer alignmentwith large uncertainty a trans-fer alignment algorithm based on dual model is presentedThe simulation and vehicle test results demonstrate that thismethod could combine the advantages of nonlinear andlinear error models which not only can be used in inertialnavigation system with large uncertainty but also has thesame high accuracy as the linear system

Conflict of Interests

The authors declare that there is no conflict of interestsregarding the publication of this paper

Acknowledgments

This work was supported by NSAF (Grant no U1330133) andthe Natural Science Foundation of Jiangsu Province (GrantBK20130774)

References

[1] J Kain and J Cloutier ldquoRapid transfer alignment for tacticalweapon applicationsrdquo AIAA Paper 89-3581 The AmericanInstitute of Aeronautics and Astronautics 1989

[2] Y Luo G Wei X Ding and Y Liu ldquoController design for 2-D stochastic nonlinear Roesser model a probability-dependentgain-scheduling approachrdquo Journal of the Franklin Institute vol351 no 11 pp 5182ndash5203 2014

[3] H Hong J Lee and G Park ldquoIn-flight alignment of SDINSunder large initial heading errorrdquo in Proceedings of the AIAAGuidance Navigation and Control Conference and ExhibitAIAA Paper 2001-4183 Montreal Canada August 2001

[4] L Wang G Wei and W Li ldquoProbability-dependent 119867infin

synchronization control for dynamical networkswith randomlyvarying nonlinearitiesrdquo Neurocomputing vol 133 pp 369ndash3762014

[5] L Wang G Wei and H Shu ldquoState estimation for complexnetworks with randomly occurring coupling delaysrdquo Neuro-computing vol 122 pp 513ndash520 2013

[6] J Liang F Sun and X Liu ldquoFinite-horizon 119867infin

filteringfor time-varying delay systems with randomly varying non-linearities and sensor saturationsrdquo Systems Science amp ControlEngineering vol 2 no 1 pp 108ndash118 2014

[7] A Ghanbari and M Moghanni-Bavil-Olyaei ldquoAdaptive fuzzyterminal sliding-mode control of MEMS z-axis gyroscope withextended Kalman filter observerrdquo Systems Science and ControlEngineering vol 2 no 1 pp 183ndash191 2014

[8] M Darouach and H S Ali ldquoOptimal unbiased functionalfiltering in the frequency domainrdquo Systems Science amp ControlEngineering vol 2 no 1 pp 308ndash315 2014

[9] D Ding Z Wang J Hu and H Shu ldquoDissipative control forstate-saturated discrete time-varying systems with randomlyoccurring nonlinearities and missing measurementsrdquo Interna-tional Journal of Control vol 86 no 4 pp 674ndash688 2013

[10] J Hu Z Wang H Gao and L K Stergioulas ldquoProbability-guaranteed 119867

infinfinite-horizon filtering for a class of nonlinear

time-varying systems with sensor saturationsrdquo Systems andControl Letters vol 61 no 4 pp 477ndash484 2012

[11] S J Julier J K Uhlmann and H F Durrant-Whyte ldquoA newapproach for filtering nonlinear systemsrdquo in Proceedings ofthe American Control Conference vol 3 pp 1628ndash1632 IEEESeattle Wash USA Jun 1995

[12] K J Shortelle W R Graham and C Rabourn ldquoF-16 flight testsof a rapid transfer alignment procedurerdquo in Proceedings of thIEEEPosition Location andNavigation Symposium pp 379ndash386IEEE Palm Springs Calif USA April 1998

[13] B Shen Z Wang H Shu and G Wei ldquoRobust 119867infin

finite-horizon filtering with randomly occurred nonlinearities andquantization effectsrdquo Automatica vol 46 no 11 pp 1743ndash17512010

[14] H Dong Z Wang J Lam and H Gao ldquoDistributed filteringin sensor networks with randomly occurring saturations andsuccessive packet dropoutsrdquo International Journal of Robust andNonlinear Control vol 24 no 12 pp 1743ndash1759 2014

Submit your manuscripts athttpwwwhindawicom

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

MathematicsJournal of

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Mathematical Problems in Engineering

Hindawi Publishing Corporationhttpwwwhindawicom

Differential EquationsInternational Journal of

Volume 2014

Applied MathematicsJournal of

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Probability and StatisticsHindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Journal of

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Mathematical PhysicsAdvances in

Complex AnalysisJournal of

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

OptimizationJournal of

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

CombinatoricsHindawi Publishing Corporationhttpwwwhindawicom Volume 2014

International Journal of

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Operations ResearchAdvances in

Journal of

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Function Spaces

Abstract and Applied AnalysisHindawi Publishing Corporationhttpwwwhindawicom Volume 2014

International Journal of Mathematics and Mathematical Sciences

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

The Scientific World JournalHindawi Publishing Corporation httpwwwhindawicom Volume 2014

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Algebra

Discrete Dynamics in Nature and Society

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Decision SciencesAdvances in

Discrete MathematicsJournal of

Hindawi Publishing Corporationhttpwwwhindawicom

Volume 2014 Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Stochastic AnalysisInternational Journal of

Page 3: Research Article Study on a Twice Transfer Alignment Based ...Research Article Study on a Twice Transfer Alignment Based on Dual Model ShuaiChen, 1 RunwuZhong, 1 XiaohuiLiu, 2,3 andAhmedAlsaedi

Discrete Dynamics in Nature and Society 3

0 2 4 6 8 10

0

5

Time (s)

Pitch estimation error

Case A Case B

6 8 10

0

minus25

minus20

minus15

minus10

minus5

minus05

05

(∘)

(a)

0 2 4 6 8 10Time (s)

Roll estimation error

0

5

Case A Case B

minus20

minus15

minus10

minus5

minus02

minus04

02(∘)

0

6 8 10

(b)

Yaw estimation error

0 2 4 6 8 10

0

Time (s)

Case A Case B

6 8 10

minus25

minus20

minus15

minus10

minus5

minus06

minus08

minus1

(∘)

(c)

Figure 1 The attitude estimation error of first phase

Table 1 Alignment accuracy comparison

Estimated error of attitude (∘)Pitch Roll Yaw

Case A 0002 0001 0005Case B 012 022 018

only have higher rate of convergence but also are smootherthan blue curves In particular the red curves all convergewithin 0005∘ Instead the blue curves fluctuate within arange of 022∘ The results show that the dual model has

obviously a faster convergent speed and higher accuracy thanthat in Case B

22 Vehicle Test and Results In order to verify the perfor-mance of the proposed algorithm vehicle tests are conducted[12ndash14] The test configuration is illustrated in Figure 3 Aslab and four steel dowels are machined which could beused to artificially misalign the SINS from the MINS (MasterInertialNavigation System) in pitch roll and yaw In practicalengineering the model based additive quaternion is difficultto establish However if the rough misalignment is knownthe attitude of SINS can be calibrated directly and the first

4 Discrete Dynamics in Nature and Society

10 15 20 25 30 35 40 45 50 55 60Time (s)

Pitch estimation error

Case A Case B

(∘)

minus07

minus06

minus05

minus04

minus03

minus02

minus01

0

01

02

03

(a)

10 15 20 25 30 35 40 45 50 55 60Time (s)

minus05

minus04

minus03

minus02

minus01

0

01

02

03Roll estimation error

Case A Case B

(∘)

(b)

10 15 20 25 30 35 40 45 50 55 60Time (s)

minus1

minus08

minus06

minus04

minus02

0

02

Yaw estimation error

Case A Case B

(∘)

(c)

Figure 2 The attitude estimation error of second phase

Figure 3 SINS and MINS of the vehicle test

phase can be skippedwhichmeans a twice transfer alignmentcan be directly conducted with the rough misalignment Theperformance of transfer alignment is assessed with differentassumed misalignments Figure 4 illustrates the alignmentresults

In Figure 3 the SINS and MINS are bolted to the slab inthe test The steel dowels are used to establish misalignmentsin three axes intentionally In the test the misalignmentsin pitch roll and yaw are set at about 10∘ 0∘ and 33∘respectively The positive roll and return-to-level maneuveris adopted in tests which can be called wing-rock maneuverOnce transfer alignment begins one end of the slab ismanually tilted up and set back down in the vehicle

Discrete Dynamics in Nature and Society 5

0 20 40 60 80 100

Estimated attitude misalignment

t (s)

95

10

105

11

Pitc

h m

isalig

nmen

t(∘)

(a)

0 20 40 60 80 100t (s)

minus1

minus05

0

05

Roll

misa

lignm

ent

(∘)

(b)

0 20 40 60 80 100t (s)

32

33

34

Yaw

misa

lignm

ent

(∘)

(105∘ 0∘ 33∘)(105∘ 0∘ 335∘)(10∘ 0∘ 33∘)

(c)

Figure 4 Curve of the vehicle results

Figure 4 compares the estimated attitude misalignmentsin three axes when the assumed misalignments used tocalibrate attitude of SINS are different In the figure attitudemisalignments are accurately estimated in spite of the factthat the assumed misalignments are different The deviationof the estimated value is less than 01∘

3 Conclusion

In order to satisfy the requirements of rapidity and highaccuracy in transfer alignmentwith large uncertainty a trans-fer alignment algorithm based on dual model is presentedThe simulation and vehicle test results demonstrate that thismethod could combine the advantages of nonlinear andlinear error models which not only can be used in inertialnavigation system with large uncertainty but also has thesame high accuracy as the linear system

Conflict of Interests

The authors declare that there is no conflict of interestsregarding the publication of this paper

Acknowledgments

This work was supported by NSAF (Grant no U1330133) andthe Natural Science Foundation of Jiangsu Province (GrantBK20130774)

References

[1] J Kain and J Cloutier ldquoRapid transfer alignment for tacticalweapon applicationsrdquo AIAA Paper 89-3581 The AmericanInstitute of Aeronautics and Astronautics 1989

[2] Y Luo G Wei X Ding and Y Liu ldquoController design for 2-D stochastic nonlinear Roesser model a probability-dependentgain-scheduling approachrdquo Journal of the Franklin Institute vol351 no 11 pp 5182ndash5203 2014

[3] H Hong J Lee and G Park ldquoIn-flight alignment of SDINSunder large initial heading errorrdquo in Proceedings of the AIAAGuidance Navigation and Control Conference and ExhibitAIAA Paper 2001-4183 Montreal Canada August 2001

[4] L Wang G Wei and W Li ldquoProbability-dependent 119867infin

synchronization control for dynamical networkswith randomlyvarying nonlinearitiesrdquo Neurocomputing vol 133 pp 369ndash3762014

[5] L Wang G Wei and H Shu ldquoState estimation for complexnetworks with randomly occurring coupling delaysrdquo Neuro-computing vol 122 pp 513ndash520 2013

[6] J Liang F Sun and X Liu ldquoFinite-horizon 119867infin

filteringfor time-varying delay systems with randomly varying non-linearities and sensor saturationsrdquo Systems Science amp ControlEngineering vol 2 no 1 pp 108ndash118 2014

[7] A Ghanbari and M Moghanni-Bavil-Olyaei ldquoAdaptive fuzzyterminal sliding-mode control of MEMS z-axis gyroscope withextended Kalman filter observerrdquo Systems Science and ControlEngineering vol 2 no 1 pp 183ndash191 2014

[8] M Darouach and H S Ali ldquoOptimal unbiased functionalfiltering in the frequency domainrdquo Systems Science amp ControlEngineering vol 2 no 1 pp 308ndash315 2014

[9] D Ding Z Wang J Hu and H Shu ldquoDissipative control forstate-saturated discrete time-varying systems with randomlyoccurring nonlinearities and missing measurementsrdquo Interna-tional Journal of Control vol 86 no 4 pp 674ndash688 2013

[10] J Hu Z Wang H Gao and L K Stergioulas ldquoProbability-guaranteed 119867

infinfinite-horizon filtering for a class of nonlinear

time-varying systems with sensor saturationsrdquo Systems andControl Letters vol 61 no 4 pp 477ndash484 2012

[11] S J Julier J K Uhlmann and H F Durrant-Whyte ldquoA newapproach for filtering nonlinear systemsrdquo in Proceedings ofthe American Control Conference vol 3 pp 1628ndash1632 IEEESeattle Wash USA Jun 1995

[12] K J Shortelle W R Graham and C Rabourn ldquoF-16 flight testsof a rapid transfer alignment procedurerdquo in Proceedings of thIEEEPosition Location andNavigation Symposium pp 379ndash386IEEE Palm Springs Calif USA April 1998

[13] B Shen Z Wang H Shu and G Wei ldquoRobust 119867infin

finite-horizon filtering with randomly occurred nonlinearities andquantization effectsrdquo Automatica vol 46 no 11 pp 1743ndash17512010

[14] H Dong Z Wang J Lam and H Gao ldquoDistributed filteringin sensor networks with randomly occurring saturations andsuccessive packet dropoutsrdquo International Journal of Robust andNonlinear Control vol 24 no 12 pp 1743ndash1759 2014

Submit your manuscripts athttpwwwhindawicom

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

MathematicsJournal of

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Mathematical Problems in Engineering

Hindawi Publishing Corporationhttpwwwhindawicom

Differential EquationsInternational Journal of

Volume 2014

Applied MathematicsJournal of

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Probability and StatisticsHindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Journal of

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Mathematical PhysicsAdvances in

Complex AnalysisJournal of

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

OptimizationJournal of

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

CombinatoricsHindawi Publishing Corporationhttpwwwhindawicom Volume 2014

International Journal of

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Operations ResearchAdvances in

Journal of

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Function Spaces

Abstract and Applied AnalysisHindawi Publishing Corporationhttpwwwhindawicom Volume 2014

International Journal of Mathematics and Mathematical Sciences

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

The Scientific World JournalHindawi Publishing Corporation httpwwwhindawicom Volume 2014

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Algebra

Discrete Dynamics in Nature and Society

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Decision SciencesAdvances in

Discrete MathematicsJournal of

Hindawi Publishing Corporationhttpwwwhindawicom

Volume 2014 Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Stochastic AnalysisInternational Journal of

Page 4: Research Article Study on a Twice Transfer Alignment Based ...Research Article Study on a Twice Transfer Alignment Based on Dual Model ShuaiChen, 1 RunwuZhong, 1 XiaohuiLiu, 2,3 andAhmedAlsaedi

4 Discrete Dynamics in Nature and Society

10 15 20 25 30 35 40 45 50 55 60Time (s)

Pitch estimation error

Case A Case B

(∘)

minus07

minus06

minus05

minus04

minus03

minus02

minus01

0

01

02

03

(a)

10 15 20 25 30 35 40 45 50 55 60Time (s)

minus05

minus04

minus03

minus02

minus01

0

01

02

03Roll estimation error

Case A Case B

(∘)

(b)

10 15 20 25 30 35 40 45 50 55 60Time (s)

minus1

minus08

minus06

minus04

minus02

0

02

Yaw estimation error

Case A Case B

(∘)

(c)

Figure 2 The attitude estimation error of second phase

Figure 3 SINS and MINS of the vehicle test

phase can be skippedwhichmeans a twice transfer alignmentcan be directly conducted with the rough misalignment Theperformance of transfer alignment is assessed with differentassumed misalignments Figure 4 illustrates the alignmentresults

In Figure 3 the SINS and MINS are bolted to the slab inthe test The steel dowels are used to establish misalignmentsin three axes intentionally In the test the misalignmentsin pitch roll and yaw are set at about 10∘ 0∘ and 33∘respectively The positive roll and return-to-level maneuveris adopted in tests which can be called wing-rock maneuverOnce transfer alignment begins one end of the slab ismanually tilted up and set back down in the vehicle

Discrete Dynamics in Nature and Society 5

0 20 40 60 80 100

Estimated attitude misalignment

t (s)

95

10

105

11

Pitc

h m

isalig

nmen

t(∘)

(a)

0 20 40 60 80 100t (s)

minus1

minus05

0

05

Roll

misa

lignm

ent

(∘)

(b)

0 20 40 60 80 100t (s)

32

33

34

Yaw

misa

lignm

ent

(∘)

(105∘ 0∘ 33∘)(105∘ 0∘ 335∘)(10∘ 0∘ 33∘)

(c)

Figure 4 Curve of the vehicle results

Figure 4 compares the estimated attitude misalignmentsin three axes when the assumed misalignments used tocalibrate attitude of SINS are different In the figure attitudemisalignments are accurately estimated in spite of the factthat the assumed misalignments are different The deviationof the estimated value is less than 01∘

3 Conclusion

In order to satisfy the requirements of rapidity and highaccuracy in transfer alignmentwith large uncertainty a trans-fer alignment algorithm based on dual model is presentedThe simulation and vehicle test results demonstrate that thismethod could combine the advantages of nonlinear andlinear error models which not only can be used in inertialnavigation system with large uncertainty but also has thesame high accuracy as the linear system

Conflict of Interests

The authors declare that there is no conflict of interestsregarding the publication of this paper

Acknowledgments

This work was supported by NSAF (Grant no U1330133) andthe Natural Science Foundation of Jiangsu Province (GrantBK20130774)

References

[1] J Kain and J Cloutier ldquoRapid transfer alignment for tacticalweapon applicationsrdquo AIAA Paper 89-3581 The AmericanInstitute of Aeronautics and Astronautics 1989

[2] Y Luo G Wei X Ding and Y Liu ldquoController design for 2-D stochastic nonlinear Roesser model a probability-dependentgain-scheduling approachrdquo Journal of the Franklin Institute vol351 no 11 pp 5182ndash5203 2014

[3] H Hong J Lee and G Park ldquoIn-flight alignment of SDINSunder large initial heading errorrdquo in Proceedings of the AIAAGuidance Navigation and Control Conference and ExhibitAIAA Paper 2001-4183 Montreal Canada August 2001

[4] L Wang G Wei and W Li ldquoProbability-dependent 119867infin

synchronization control for dynamical networkswith randomlyvarying nonlinearitiesrdquo Neurocomputing vol 133 pp 369ndash3762014

[5] L Wang G Wei and H Shu ldquoState estimation for complexnetworks with randomly occurring coupling delaysrdquo Neuro-computing vol 122 pp 513ndash520 2013

[6] J Liang F Sun and X Liu ldquoFinite-horizon 119867infin

filteringfor time-varying delay systems with randomly varying non-linearities and sensor saturationsrdquo Systems Science amp ControlEngineering vol 2 no 1 pp 108ndash118 2014

[7] A Ghanbari and M Moghanni-Bavil-Olyaei ldquoAdaptive fuzzyterminal sliding-mode control of MEMS z-axis gyroscope withextended Kalman filter observerrdquo Systems Science and ControlEngineering vol 2 no 1 pp 183ndash191 2014

[8] M Darouach and H S Ali ldquoOptimal unbiased functionalfiltering in the frequency domainrdquo Systems Science amp ControlEngineering vol 2 no 1 pp 308ndash315 2014

[9] D Ding Z Wang J Hu and H Shu ldquoDissipative control forstate-saturated discrete time-varying systems with randomlyoccurring nonlinearities and missing measurementsrdquo Interna-tional Journal of Control vol 86 no 4 pp 674ndash688 2013

[10] J Hu Z Wang H Gao and L K Stergioulas ldquoProbability-guaranteed 119867

infinfinite-horizon filtering for a class of nonlinear

time-varying systems with sensor saturationsrdquo Systems andControl Letters vol 61 no 4 pp 477ndash484 2012

[11] S J Julier J K Uhlmann and H F Durrant-Whyte ldquoA newapproach for filtering nonlinear systemsrdquo in Proceedings ofthe American Control Conference vol 3 pp 1628ndash1632 IEEESeattle Wash USA Jun 1995

[12] K J Shortelle W R Graham and C Rabourn ldquoF-16 flight testsof a rapid transfer alignment procedurerdquo in Proceedings of thIEEEPosition Location andNavigation Symposium pp 379ndash386IEEE Palm Springs Calif USA April 1998

[13] B Shen Z Wang H Shu and G Wei ldquoRobust 119867infin

finite-horizon filtering with randomly occurred nonlinearities andquantization effectsrdquo Automatica vol 46 no 11 pp 1743ndash17512010

[14] H Dong Z Wang J Lam and H Gao ldquoDistributed filteringin sensor networks with randomly occurring saturations andsuccessive packet dropoutsrdquo International Journal of Robust andNonlinear Control vol 24 no 12 pp 1743ndash1759 2014

Submit your manuscripts athttpwwwhindawicom

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

MathematicsJournal of

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Mathematical Problems in Engineering

Hindawi Publishing Corporationhttpwwwhindawicom

Differential EquationsInternational Journal of

Volume 2014

Applied MathematicsJournal of

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Probability and StatisticsHindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Journal of

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Mathematical PhysicsAdvances in

Complex AnalysisJournal of

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

OptimizationJournal of

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

CombinatoricsHindawi Publishing Corporationhttpwwwhindawicom Volume 2014

International Journal of

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Operations ResearchAdvances in

Journal of

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Function Spaces

Abstract and Applied AnalysisHindawi Publishing Corporationhttpwwwhindawicom Volume 2014

International Journal of Mathematics and Mathematical Sciences

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

The Scientific World JournalHindawi Publishing Corporation httpwwwhindawicom Volume 2014

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Algebra

Discrete Dynamics in Nature and Society

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Decision SciencesAdvances in

Discrete MathematicsJournal of

Hindawi Publishing Corporationhttpwwwhindawicom

Volume 2014 Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Stochastic AnalysisInternational Journal of

Page 5: Research Article Study on a Twice Transfer Alignment Based ...Research Article Study on a Twice Transfer Alignment Based on Dual Model ShuaiChen, 1 RunwuZhong, 1 XiaohuiLiu, 2,3 andAhmedAlsaedi

Discrete Dynamics in Nature and Society 5

0 20 40 60 80 100

Estimated attitude misalignment

t (s)

95

10

105

11

Pitc

h m

isalig

nmen

t(∘)

(a)

0 20 40 60 80 100t (s)

minus1

minus05

0

05

Roll

misa

lignm

ent

(∘)

(b)

0 20 40 60 80 100t (s)

32

33

34

Yaw

misa

lignm

ent

(∘)

(105∘ 0∘ 33∘)(105∘ 0∘ 335∘)(10∘ 0∘ 33∘)

(c)

Figure 4 Curve of the vehicle results

Figure 4 compares the estimated attitude misalignmentsin three axes when the assumed misalignments used tocalibrate attitude of SINS are different In the figure attitudemisalignments are accurately estimated in spite of the factthat the assumed misalignments are different The deviationof the estimated value is less than 01∘

3 Conclusion

In order to satisfy the requirements of rapidity and highaccuracy in transfer alignmentwith large uncertainty a trans-fer alignment algorithm based on dual model is presentedThe simulation and vehicle test results demonstrate that thismethod could combine the advantages of nonlinear andlinear error models which not only can be used in inertialnavigation system with large uncertainty but also has thesame high accuracy as the linear system

Conflict of Interests

The authors declare that there is no conflict of interestsregarding the publication of this paper

Acknowledgments

This work was supported by NSAF (Grant no U1330133) andthe Natural Science Foundation of Jiangsu Province (GrantBK20130774)

References

[1] J Kain and J Cloutier ldquoRapid transfer alignment for tacticalweapon applicationsrdquo AIAA Paper 89-3581 The AmericanInstitute of Aeronautics and Astronautics 1989

[2] Y Luo G Wei X Ding and Y Liu ldquoController design for 2-D stochastic nonlinear Roesser model a probability-dependentgain-scheduling approachrdquo Journal of the Franklin Institute vol351 no 11 pp 5182ndash5203 2014

[3] H Hong J Lee and G Park ldquoIn-flight alignment of SDINSunder large initial heading errorrdquo in Proceedings of the AIAAGuidance Navigation and Control Conference and ExhibitAIAA Paper 2001-4183 Montreal Canada August 2001

[4] L Wang G Wei and W Li ldquoProbability-dependent 119867infin

synchronization control for dynamical networkswith randomlyvarying nonlinearitiesrdquo Neurocomputing vol 133 pp 369ndash3762014

[5] L Wang G Wei and H Shu ldquoState estimation for complexnetworks with randomly occurring coupling delaysrdquo Neuro-computing vol 122 pp 513ndash520 2013

[6] J Liang F Sun and X Liu ldquoFinite-horizon 119867infin

filteringfor time-varying delay systems with randomly varying non-linearities and sensor saturationsrdquo Systems Science amp ControlEngineering vol 2 no 1 pp 108ndash118 2014

[7] A Ghanbari and M Moghanni-Bavil-Olyaei ldquoAdaptive fuzzyterminal sliding-mode control of MEMS z-axis gyroscope withextended Kalman filter observerrdquo Systems Science and ControlEngineering vol 2 no 1 pp 183ndash191 2014

[8] M Darouach and H S Ali ldquoOptimal unbiased functionalfiltering in the frequency domainrdquo Systems Science amp ControlEngineering vol 2 no 1 pp 308ndash315 2014

[9] D Ding Z Wang J Hu and H Shu ldquoDissipative control forstate-saturated discrete time-varying systems with randomlyoccurring nonlinearities and missing measurementsrdquo Interna-tional Journal of Control vol 86 no 4 pp 674ndash688 2013

[10] J Hu Z Wang H Gao and L K Stergioulas ldquoProbability-guaranteed 119867

infinfinite-horizon filtering for a class of nonlinear

time-varying systems with sensor saturationsrdquo Systems andControl Letters vol 61 no 4 pp 477ndash484 2012

[11] S J Julier J K Uhlmann and H F Durrant-Whyte ldquoA newapproach for filtering nonlinear systemsrdquo in Proceedings ofthe American Control Conference vol 3 pp 1628ndash1632 IEEESeattle Wash USA Jun 1995

[12] K J Shortelle W R Graham and C Rabourn ldquoF-16 flight testsof a rapid transfer alignment procedurerdquo in Proceedings of thIEEEPosition Location andNavigation Symposium pp 379ndash386IEEE Palm Springs Calif USA April 1998

[13] B Shen Z Wang H Shu and G Wei ldquoRobust 119867infin

finite-horizon filtering with randomly occurred nonlinearities andquantization effectsrdquo Automatica vol 46 no 11 pp 1743ndash17512010

[14] H Dong Z Wang J Lam and H Gao ldquoDistributed filteringin sensor networks with randomly occurring saturations andsuccessive packet dropoutsrdquo International Journal of Robust andNonlinear Control vol 24 no 12 pp 1743ndash1759 2014

Submit your manuscripts athttpwwwhindawicom

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

MathematicsJournal of

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Mathematical Problems in Engineering

Hindawi Publishing Corporationhttpwwwhindawicom

Differential EquationsInternational Journal of

Volume 2014

Applied MathematicsJournal of

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Probability and StatisticsHindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Journal of

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Mathematical PhysicsAdvances in

Complex AnalysisJournal of

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

OptimizationJournal of

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

CombinatoricsHindawi Publishing Corporationhttpwwwhindawicom Volume 2014

International Journal of

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Operations ResearchAdvances in

Journal of

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Function Spaces

Abstract and Applied AnalysisHindawi Publishing Corporationhttpwwwhindawicom Volume 2014

International Journal of Mathematics and Mathematical Sciences

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

The Scientific World JournalHindawi Publishing Corporation httpwwwhindawicom Volume 2014

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Algebra

Discrete Dynamics in Nature and Society

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Decision SciencesAdvances in

Discrete MathematicsJournal of

Hindawi Publishing Corporationhttpwwwhindawicom

Volume 2014 Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Stochastic AnalysisInternational Journal of

Page 6: Research Article Study on a Twice Transfer Alignment Based ...Research Article Study on a Twice Transfer Alignment Based on Dual Model ShuaiChen, 1 RunwuZhong, 1 XiaohuiLiu, 2,3 andAhmedAlsaedi

Submit your manuscripts athttpwwwhindawicom

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

MathematicsJournal of

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Mathematical Problems in Engineering

Hindawi Publishing Corporationhttpwwwhindawicom

Differential EquationsInternational Journal of

Volume 2014

Applied MathematicsJournal of

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Probability and StatisticsHindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Journal of

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Mathematical PhysicsAdvances in

Complex AnalysisJournal of

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

OptimizationJournal of

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

CombinatoricsHindawi Publishing Corporationhttpwwwhindawicom Volume 2014

International Journal of

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Operations ResearchAdvances in

Journal of

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Function Spaces

Abstract and Applied AnalysisHindawi Publishing Corporationhttpwwwhindawicom Volume 2014

International Journal of Mathematics and Mathematical Sciences

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

The Scientific World JournalHindawi Publishing Corporation httpwwwhindawicom Volume 2014

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Algebra

Discrete Dynamics in Nature and Society

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Decision SciencesAdvances in

Discrete MathematicsJournal of

Hindawi Publishing Corporationhttpwwwhindawicom

Volume 2014 Hindawi Publishing Corporationhttpwwwhindawicom Volume 2014

Stochastic AnalysisInternational Journal of