2000 character limit reached
Kinematic Base State Estimation for Humanoid using Invariant Extended Kalman Filter (2401.02786v1)
Published 5 Jan 2024 in cs.RO
Abstract: This paper presents the design and implementation of a Right Invariant Extended Kalman Filter (RIEKF) for estimating the states of the kinematic base of the Surena V humanoid robot. The state representation of the robot is defined on the Lie group $SE_4(3)$, encompassing the position, velocity, and orientation of the base, as well as the position of the left and right feet. In addition, we incorporated IMU biases as concatenated states within the filter. The prediction step of the RIEKF utilizes IMU equations, while the update step incorporates forward kinematics. To evaluate the performance of the RIEKF, we conducted experiments using the Choreonoid dynamic simulation framework and compared it against a Quaternion-based Extended Kalman Filter (QEKF). The results of the analysis demonstrate that the RIEKF exhibits reduced drift in localization and achieves estimation convergence in a shorter time compared to the QEKF. These findings highlight the effectiveness of the proposed RIEKF for accurate state estimation of the kinematic base in humanoid robotics.
- K. Masuya and K. Ayusawa, “A review of state estimation of humanoid robot targeting the center of mass, base kinematics, and external wrench,” Advanced Robotics, vol. 34, no. 21-22, pp. 1380–1389, 2020.
- H. Jeong, I. Lee, J. Oh, K. K. Lee, and J.-H. Oh, “A robust walking controller based on online optimization of ankle, hip, and stepping strategies,” IEEE Transactions on Robotics, vol. 35, no. 6, pp. 1367–1386, 2019.
- P. Abdolahnezhad, A. Yousefi-Koma, A. Vedadi, K. Sinaei, B. Maleki, and M. Shafiee, “Online bipedal locomotion adaptation for stepping on obstacles using a novel foot sensor,” in 2022 IEEE-RAS 21st International Conference on Humanoid Robots (Humanoids). IEEE, 2022, pp. 344–349.
- M. Bloesch, M. Hutter, M. A. Hoepflinger, S. Leutenegger, C. Gehring, C. D. Remy, and R. Siegwart, “State estimation for legged robots-consistent fusion of leg kinematics and imu,” Robotics, vol. 17, pp. 17–24, 2013.
- N. Rotella, M. Blösch, L. Righetti, and S. Schaal, “State estimation for a humanoid robot,” CoRR, vol. abs/1402.5450, 2014. [Online]. Available: http://arxiv.org/abs/1402.5450
- M. F. Fallon, M. Antone, N. Roy, and S. Teller, “Drift-free humanoid state estimation fusing kinematic, inertial and lidar sensing,” in 2014 IEEE-RAS International Conference on Humanoid Robots. IEEE, 2014, pp. 112–119.
- J. Sola, “Quaternion kinematics for the error-state kalman filter,” arXiv preprint arXiv:1711.02508, 2017.
- G. Bourmaud, R. Mégret, M. Arnaudon, and A. Giremus, “Continuous-discrete extended kalman filter on matrix lie groups using concentrated gaussian distributions,” Journal of Mathematical Imaging and Vision, vol. 51, no. 1, pp. 209–228, 2015.
- S. Bonnabel and P. Rouchon, “On invariant observers,” in Control and observer design for nonlinear finite and infinite dimensional systems. Springer, 2005, pp. 53–65.
- A. Barrau and S. Bonnabel, “The invariant extended kalman filter as a stable observer,” IEEE Transactions on Automatic Control, vol. 62, no. 4, pp. 1797–1812, 2016.
- R. Hartley, M. Ghaffari, R. M. Eustice, and J. W. Grizzle, “Contact-aided invariant extended kalman filtering for robot state estimation,” The International Journal of Robotics Research, vol. 39, no. 4, pp. 402–430, 2020.
- S. Teng, M. W. Mueller, and K. Sreenath, “Legged robot state estimation in slippery environments using invariant extended kalman filter with velocity update,” in 2021 IEEE International Conference on Robotics and Automation (ICRA). IEEE, 2021, pp. 3104–3110.
- P. Ramadoss, G. Romualdi, S. Dafarra, F. J. A. Chavez, S. Traversaro, and D. Pucci, “Diligent-kio: A proprioceptive base estimator for humanoid robots using extended kalman filtering on matrix lie groups,” in 2021 IEEE International Conference on Robotics and Automation (ICRA). IEEE, 2021, pp. 2904–2910.
- S. Nakaoka, “Choreonoid: Extensible virtual robot environment built on an integrated gui framework,” in 2012 IEEE/SICE International Symposium on System Integration (SII). IEEE, 2012, pp. 79–85.
- J. Sola, J. Deray, and D. Atchuthan, “A micro lie theory for state estimation in robotics,” arXiv preprint arXiv:1812.01537, 2018.
- A. Barrau, “Non-linear state error based extended kalman filters with applications to navigation,” Ph.D. dissertation, Mines Paristech, 2015.
- K. Eckenhoff, P. Geneva, and G. Huang, “Direct visual-inertial navigation with analytical preintegration,” in 2017 IEEE International Conference on Robotics and Automation (ICRA). IEEE, 2017, pp. 1429–1435.
- H. Jeong, I. Lee, O. Sim, K. Lee, and J.-H. Oh, “A robust walking controller optimizing step position and step time that exploit advantages of footed robot,” Robotics and Autonomous Systems, vol. 113, pp. 10–22, 2019.
- S. Caron, A. Kheddar, and O. Tempier, “Stair climbing stabilization of the hrp-4 humanoid robot using whole-body admittance control,” in 2019 International conference on robotics and automation (ICRA). IEEE, 2019, pp. 277–283.
- A. Vedadi, K. Sinaei, P. Abdolahnezhad, S. S. Aboumasoudi, and A. Yousefi-Koma, “Bipedal locomotion optimization by exploitation of the full dynamics in dcm trajectory planning,” in 2021 9th RSI International Conference on Robotics and Mechatronics (ICRoM). IEEE, 2021, pp. 365–370.