Pose estimation by extended Kalman filter using noise covariance matrices based on sensor output

ROBOMECH Journal

article

Ayuko Saito¹  Satoru Kizawa²  Yoshikazu Kobayashi²  Kazuto Miyawaki² 

[1] Department of Mechanical Science and Engineering, Kogakuin University;Department of Mechanical Engineering and Robotics, National Institute of Technology (KOSEN), Akita College

关键词: Kalman filter;    Motion sensor;    Noise covariance matrix;    Pose estimation;    Sensor fusion;   

DOI  :  10.1186/s40648-020-00185-y

学科分类：社会科学、人文和艺术（综合）

来源: Springer

【 摘 要 】

This paper presents an extended Kalman filter for pose estimation using noise covariance matrices based on sensor output. Compact and lightweight nine-axis motion sensors are used for motion analysis in widely various fields such as medical welfare and sports. A nine-axis motion sensor includes a three-axis gyroscope, a three-axis accelerometer, and a three-axis magnetometer. Information obtained from the three sensors is useful for estimating joint angles using the Kalman filter. The extended Kalman filter is used widely for state estimation because it can estimate the status with a small computational load. However, determining the process and observation noise covariance matrices in the extended Kalman filter is complicated. The noise covariance matrices in the extended Kalman filter were found for this study based on the sensor output. Postural change appears in the gyroscope output because the rotational motion of the joints produces human movement. Therefore, the process noise covariance matrix was determined based on the gyroscope output. An observation noise covariance matrix was determined based on the accelerometer and magnetometer output because the two sensors’ outputs were used as observation values. During a laboratory experiment, the lower limb joint angles of three participants were measured using an optical 3D motion analysis system and nine-axis motion sensors while participants were walking. The lower limb joint angles estimated using the extended Kalman filter with noise covariance matrices based on sensor output were generally consistent with results obtained from the optical 3D motion analysis system. Furthermore, the lower limb joint angles were measured using nine-axis motion sensors while participants were running in place for about 100 s. The experiment results demonstrated the effectiveness of the proposed method for human pose estimation.

【 授权许可】

CC BY