A Leveling Algorithm for Strapdown Inertial Navigation System Using Extended Kalman Filter

화장칼만필터를 이용한 스티랩다운 관성항법시스템의 수평축 정렬 알고리즘

  • 홍현수 (서울대학교 전기.컴퓨터공학부) ;
  • 박찬국 (광운대학교 제어계측공학과) ;
  • 한형석 (경원대학교 전기전자공학부) ;
  • 이장규 (서울대학교 전기.컴퓨터공학부)
  • Published : 2001.01.01


This paper presents a new leveling algorithm that estimates the initial horizontal angles composed of roll angle and pitch angle for a moving or stationary vehicle. The system model of the EKF is designed by linearizing the nonlinear Euler angle differential equation. The measurement models are designed for the moving case and for the stationary case, respectively. The simulation results show that the leveling algorithm is ade-quate not only for acquiring the initial horizontal angles of the vehicle in the motion with acceleration and rotation but also for the stationary one.


  1. 김영한, '퍼지 이론을 이용한 수중운동체의 자세계산 혼합 알고리즘', 공학석사학위논문,서울대학교, 1995
  2. Kenneth R. Britting, Intertial Navigation Systems Analysis, Wiley-Interscience, 1971
  3. 박찬국, 김광진, 박홍원, 이장규, '스트랩다운 관성 항법시스템의 초기 개략 정렬 알고리즘', Proceeding of the 11th KACC, 1996
  4. J. F. Bellantoni and E. J. Koenke, 'Launch pad alignment of a strapdown navigator by the kalman filter,' AIAA Guidance, Control and Flight Dynamics Conference, AIAA 68-831, 1968
  5. G. M. Siouris, Aerospace Avionics system : A Modern Synthesis, Academic Press, 1993
  6. I. Yaesh, 'Design of leveling loop for marine navigation system', IEEE Transactions on Aerospace and Electronic Systems, vol. 29, no. 2, April, 1993 https://doi.org/10.1109/7.210101
  7. 이장무, 동역학, 동명사, 1985
  8. Jerry M. Mendel, Lessons in Estimation Theory for Signal Processing, Communications, and Control, Prentice Hall, 1995
  9. Arthur Gelb, Applied Optimal Estimation, M.I.T. Press, 1974
  10. 박성택, '확장칼만필터를 이용한 수중운동체의 유체계수 식별', 공학석사학위논문, 서울대학교, 1993
  11. 박준구, '스트랩다운 관성항법 시스템의 운항중 정렬을 위한 궤적에 따른 가관측성 분석',공학석사학위논문, 서울대학교, 1996