動加速度環境下における姿勢推定アルゴリズムの研究

抄録

In this paper, we propose the attitude estimation algorithm under the dynamic acceleration environment. Generally, an attitude sensor has biaxial or triaxial accelerometer in order to measure the direction of gravity. In this configration, the attitude sensor has serious error under the dynamic acceleration environment, because of the measurement error of gravity that is caused by the dynamic acceleration. When we put the attitude sensor on a movable body like an UAV (Unmanned Aerial Vehicle), this kind of error is fatal for the sensor. So, we apply the extended kalman filter algorithm to reduce the estimation error. Firstly, we derive the process model for the kalman filter which is based on quaternion kinematics. Secondly, we design the extended kalman filter by using the process model. Lastly, we show the simulation and experiment result of the estimation algorithm.