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

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[], and the estimator displayed good property on the prediction of the state in 100 ms measurement period.