The Journal of the Korea institute of electronic communication sciences (한국전자통신학회논문지)

Korea Institute of Electronic Communication Science (한국전자통신학회)
권호 표지
DOI QR코드

DOI QR Code

Extended Kalman Filtering for I.M.U. using MEMs Sensors

반도체 센서의 확장칼만필터를 이용한 자세추정

  • 전용호 (중원대학교 메카트로닉스학과)
  • Received : 2015.03.10
  • Accepted : 2015.04.23
  • Published : 2015.04.30
Download PDF
⟨ Previous Next ⟩

Abstract

This paper describes about the method for designing an extended Kalman filter to accurately measure the position of the spatial-phase system using a semiconductor sensor. Spatial position is expressed by the correlation of the rotated coordinate system attached to the body from the inertia coordinate system (a fixed coordinate system). To express the attitude, quaternion was adapted as a state variable, Then, the state changes were estimated from the input value which was measured in the gyro sensor. The observed data is the value obtained from the acceleration sensor. By matching between the measured value in the acceleration sensor and the predicted calculation value, the best variable was obtained. To increase the accuracy of estimation, designation of the extended Kalman filter was performed, which showed excellent ability to adjust the estimation period relative to the sensor property. As a result, when a three-axis gyro sensor and a three-axis acceleration sensor were adapted in the estimator, the RMS(Root Mean Square) estimation error in simulation was retained less than 1.7[$^{\circ}$], and the estimator displayed good property on the prediction of the state in 100 ms measurement period.

본 논문은 반도체 센서를 이용하여 공간상 시스템의 자세를 정확히 측정할 수 있도록 확장 칼만 필터를 설계하는 방법에 관한 연구이다. 공간상 자세는 관성좌표계(고정 좌표계)로부터 몸체에 부착된 회전좌표계의 상호 관계로 표현한다. 자세를 표현하는데 있어서 간결한 방법인 쿼터니언을 상태변수로 이용하며, 속도 센서로부터 계측된 값을 입력으로 가정하고, 상태 변화를 추정하였다. 그리고 가속도 센서로부터 획득된 값을 관측 데이터로 하여 추정한 값과의 정합과정을 통해 최적의 추정치를 얻어낸다. 이때 추정의 정밀도를 높이기 위해 추정 주기를 센서특성에 맞춰 조절하도록 확장 칼만 필터를 설계하였다. 그 결과, 3축 속도 센서와 3축 가속도 센서를 이용하여 설계된 추정기의 RMS(: Root Mean Square) 추정오차가 시뮬레이션에서 약 1.7 [$^{\circ}$] 이하로 유지되었고, 실험에서 100 [ms] 의 주기로 상태추정을 함으로 추정기가 유용함을 입증하였다.

Keywords

References

  1. W. T. Higgins. JR, "A Comparison of Complementary and Kalman Filtering," IEEE Trans. Aerospace and Electronic Systems, vol. AES-11, no. 3, May, 1975, pp. 321-325. https://doi.org/10.1109/TAES.1975.308081
  2. D. Roetenberg, H. Luinge, C. Baten, and P. Veltink, "Compensation of magnetic disturbances improves inertial and magnetic sensing of human body segment orientation," IEEE Trans. Neural Syst. Rehabil. Eng., vol. 13, Sept. 2005, pp. 395. https://doi.org/10.1109/TNSRE.2005.847353
  3. E. Foxlin, "Inertial head-tracker sensor fusion by a complementary separate-bias Kalman filter," IEEE Proc. of VRAIS '96, 1996. pp. 185-194.
  4. E. J. Lefferts, F. L. Markley, and M. D. Shuster, "Kalman Filtering for Spacecraft Attitude Estimation," J. of Guidance, Control, and Dynamics, vol. 5, no. 5, 1982, pp. 417-429. https://doi.org/10.2514/3.56190
  5. J. B. Kuipers, Quaternions and Rotation Sequences. Princeton : Princeton University Press, 2002.
  6. A. J. Baerveldt and R. Klang, "A low-cost and low-weight attitude estimation system for an autonomous helicopter," IEEE Int. conf. Intelligent Engineering Systems, Budapest, Hungary, Sept., 1997, pp. 391- 395.
  7. I. Y. Bar-Itzhack and Y. Oshman, "Attitude Determination from Vector Observations : Quaternion Estimation," IEEE Trans. Aerospace and Electronic Systems, vol. 21, no. 1, 2006. pp. 128-136.
  8. T. Yoo, S. Hong, H. Yoon, and S. Park, "Gain-Scheduled Complementary Filter Design for a MEMs Based Attitude and Heading Reference System," Sensors, vol. 11, no. 4, Mar, 2011, pp. 3816-3830. https://doi.org/10.3390/s110403816
  9. D. Simon, Optimal State Estimation. Hoboken : Wiley-Inter Science, 2006.
  10. H. H. Lee, W. Cho, and K. S. Lee, "Improved switching method for sensorless BLDC motor drive," J. of The Korea Institute of Electronic Communication Sciences, Vol. 5, No. 2, 2010, pp. 164-170.
  11. G. Seok, and B. Park, "A Study on the Facal motion and for Detection of area Using Kalman Fillter algorithm," J. of The Korea Institute of Electronic Communication Sciences, vol. 6, no. 6, 2011, pp. 973-980.
  12. Y. Jeon and W. Cho, "Sensorless Speed Control of IPMSM Using an Extended Kalman Filter and Nonlinear and Adaptive Back-Stepping Control Technique," J. of The Korea Institute of Electronic Communication Sciences, vol. 7, no. 6, 2012, pp. 1413-1422. https://doi.org/10.13067/JKIECS.2012.7.6.1413