UKF-Based Sensor Fusion for Joint-Torque Sensorless Humanoid Robots (2402.18380v1)
Abstract: This paper proposes a novel sensor fusion based on Unscented Kalman Filtering for the online estimation of joint-torques of humanoid robots without joint-torque sensors. At the feature level, the proposed approach considers multimodal measurements (e.g. currents, accelerations, etc.) and non-directly measurable effects, such as external contacts, thus leading to joint torques readily usable in control architectures for human-robot interaction. The proposed sensor fusion can also integrate distributed, non-collocated force/torque sensors, thus being a flexible framework with respect to the underlying robot sensor suit. To validate the approach, we show how the proposed sensor fusion can be integrated into a twolevel torque control architecture aiming at task-space torquecontrol. The performances of the proposed approach are shown through extensive tests on the new humanoid robot ergoCub, currently being developed at Istituto Italiano di Tecnologia. We also compare our strategy with the existing state-of-theart approach based on the recursive Newton-Euler algorithm. Results demonstrate that our method achieves low root mean square errors in torque tracking, ranging from 0.05 Nm to 2.5 Nm, even in the presence of external contacts.
- A. Kaplish and K. Yamane, “Motion retargeting and control for teleoperated physical human-robot interaction,” in 2019 IEEE-RAS 19th International Conference on Humanoid Robots (Humanoids), 2019, pp. 723–730.
- G. Romualdi, S. Dafarra, Y. Hu, P. Ramadoss, F. J. A. Chavez, S. Traversaro, and D. Pucci, “A benchmarking of dcm-based architectures for position, velocity and torque-controlled humanoid robots,” International Journal of Humanoid Robotics, vol. 17, no. 01, p. 1950034, 2020.
- S. Dafarra, G. Romualdi, and D. Pucci, “Dynamic complementarity conditions and whole-body trajectory optimization for humanoid robot locomotion,” IEEE Transactions on Robotics, vol. 38, no. 6, pp. 3414–3433, 2022.
- G. Mesesan, J. Englsberger, G. Garofalo, C. Ott, and A. Albu-Schäffer, “Dynamic walking on compliant and uneven terrain using dcm and passivity-based whole-body control,” in 2019 IEEE-RAS 19th International Conference on Humanoid Robots (Humanoids). IEEE, 2019, pp. 25–32.
- N. Ramuzat, G. Buondonno, S. Boria, and O. Stasse, “Comparison of position and torque whole body control schemes on the humanoid robot talos,” in 20th International Conference on Advanced Robotics (ICAR), 2021.
- A. De Luca and R. Mattone, “Sensorless robot collision detection and hybrid force/motion control,” in Proceedings of the 2005 IEEE international conference on robotics and automation. IEEE, 2005, pp. 999–1004.
- B. Henze, M. A. Roa, and C. Ott, “Passivity-based whole-body balancing for torque-controlled humanoid robots in multi-contact scenarios,” The International Journal of Robotics Research, vol. 35, no. 12, pp. 1522–1543, 2016.
- P. Ferrari, L. Rossini, F. Ruscelli, A. Laurenzi, G. Oriolo, N. G. Tsagarakis, and E. M. Hoffman, “Multi-contact planning and control for humanoid robots: Design and validation of a complete framework,” Robotics and Autonomous Systems, vol. 166, p. 104448, 2023.
- G. Romualdi, N. A. Villa, S. Dafarra, D. Pucci, and O. Stasse, “Whole-body control and estimation of humanoid robots with link flexibility,” in 2022 IEEE-RAS 21st International Conference on Humanoid Robots (Humanoids). IEEE, 2022, pp. 104–111.
- J.-K. Min, K.-H. Ahn, H.-C. Park, and J.-B. Song, “A novel reactive-type joint torque sensor with high torsional stiffness for robot applications,” Mechatronics, vol. 63, p. 102265, 2019.
- G. Romualdi, S. Dafarra, Y. Hu, and D. Pucci, “A benchmarking of dcm based architectures for position and velocity controlled walking of humanoid robots,” in 2018 IEEE-RAS 18th International Conference on Humanoid Robots (Humanoids). IEEE, 2018, pp. 1–9.
- G. Romualdi, S. Dafarra, G. L’Erario, I. Sorrentino, S. Traversaro, and D. Pucci, “Online non-linear centroidal mpc for humanoid robot locomotion with step adjustment,” arXiv e-prints, pp. arXiv–2203, 2022.
- K. Hirai, M. Hirose, Y. Haikawa, and T. Takenaka, “The development of honda humanoid robot,” in Proceedings. 1998 IEEE international conference on robotics and automation (Cat. No. 98CH36146), vol. 2. IEEE, 1998, pp. 1321–1326.
- A. Del Prete, N. Mansard, O. E. Ramos, O. Stasse, and F. Nori, “Implementing torque control with high-ratio gear boxes and without joint-torque sensors,” International Journal of Humanoid Robotics, vol. 13, no. 01, p. 1550044, 2016.
- M. Fumagalli, S. Ivaldi, M. Randazzo, L. Natale, G. Metta, G. Sandini, and F. Nori, “Force feedback exploiting tactile and proximal force/torque sensing,” Autonomous Robots, vol. 33, no. 4, pp. 381–398, 2012.
- S. Traversaro, A. Del Prete, S. Ivaldi, and F. Nori, “Inertial parameters identification and joint torques estimation with proximal force/torque sensing,” in 2015 IEEE International Conference on Robotics and Automation (ICRA). IEEE, 2015, pp. 2105–2110.
- Y. Nagamatsu, T. Shirai, H. Suzuki, Y. Kakiuchi, K. Okada, and M. Inaba, “Distributed torque estimation toward low-latency variable stiffness control for gear-driven torque sensorless humanoid,” in 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS). IEEE, 2017, pp. 5239–5244.
- E. A. Wan and R. Van Der Merwe, “The unscented kalman filter,” Kalman filtering and neural networks, pp. 221–280, 2001.
- J. K. Hackett and M. Shah, “Multi-sensor fusion: a perspective,” in Proceedings., IEEE International Conference on Robotics and Automation. IEEE, 1990, pp. 1324–1330.
- P. S. Gandhi, F. H. Ghorbel, and J. Dabney, “Modeling, identification, and compensation of friction in harmonic drives,” in Proceedings of the 41st IEEE Conference on Decision and Control, 2002., vol. 1. IEEE, 2002, pp. 160–166.
- M. A. Ismail, J. Windelberg, and G. Liu, “Simplified sensorless torque estimation method for harmonic drive based electro-mechanical actuator,” IEEE Robotics and Automation Letters, vol. 6, no. 2, pp. 835–840, 2021.
- R. Cisneros, M. Benallegue, R. Kikuuwe, M. Morisawa, and F. Kanehiro, “Reliable chattering-free simulation of friction torque in joints presenting high stiction,” in 2020 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS). IEEE, 2020, pp. 6318–6325.
- K. Johanastrom and C. Canudas-De-Wit, “Revisiting the lugre friction model,” IEEE Control systems magazine, vol. 28, no. 6, pp. 101–114, 2008.
- Z. Shi and G. Liu, “Torque estimation of robot joint with harmonic drive transmission using a redundant adaptive robust extended kalman filter,” in 2014 IEEE International Conference on Robotics and Automation (ICRA). IEEE, 2014, pp. 6382–6387.
- “Gazebo — gazebosim.org,” https://gazebosim.org/home, [Accessed 12-09-2023].
- I. Sorrentino, “paper_sorrentino_2024_icra_robot-dynamics-estimation,” https://github.com/ami-iit/paper˙sorrentino˙2024˙icra˙robot-dynamics-estimation.