Iranian Journal of Mechanical Engineering Transactions of ISME

Iranian Journal of Mechanical Engineering Transactions of ISME

Real-time DCM-based Agile Locomotion and Optimum Push Recovery of a 3D Humanoid Robot

Authors
Omid Koochakianfard 1
Majid Sadedel 2
1 M.Sc., Department of Mechanical Engineering, Tarbiat Modares University, Tehran, Iran
2 Assistant Professor, Department of Mechanical Engineering, Tarbiat Modares University, Tehran, Iran
10.30506/ijmep.2024.555378.1887
Abstract
This paper aims to achieve real-time optimum push recovery and high-speed pattern generation for a 3D humanoid robot.  For this purpose, a divergent component of motion (DCM) based locomotion is planned using a three-mass inverted pendulum model. To improve push recovery robustness in the presence of strong disturbances during walking, a quadratic optimization strategy algorithm is introduced, including weighted step time adaption, step position adjustment, and ankle strategy. The minimum error push recovery cost function is obtained through quadratic programming. To validate our proposed model different scenarios for real-time navigation of robot considering strong disturbances in various speeds of walking from 0/8 to 1/6 meters per second are analyzed. The verification methods indicate that the proposed method recovered from 34.5 N.s disturbances at 1/6 meters per second speed, while conventional push recovery methods guaranteed lower speeds robust stable locomotion in the same disturbances. In this paper, a real humanoid robot and actual physical conditions were considered for validation of navigation and robust optimum push recovery.
Keywords
Humanoid robots
Three mass inverted pendulum model
Real-time path- planning
Push recovery
Legged robots

Subjects

[1]    M. Sadedel, A. Yousefi Koma, and F. Iranmanesh, "Heel-off and Toe-off Motions Optimization for a 2D Humanoid Robot Equipped with ActiveToe Joints (2)," Modares Mechanical Engineering, Vol. 16, No. 3, pp. 87-97, 2016, http://dorl.net/dor/20.1001.1.10275940.1395.16.3.33.0.
 
[2]    M. Sadedel, A. Yousefi-Koma, M. Khadiv, and F. Iranmanesh, "Heel-strike and Toe-off Motions Optimization for Humanoid Robots Equipped with Active Toe Joints," Robotica, Vol. 36, No. 6, pp. 925-944, 2018, doi:10.1017/S0263574718000140.
 
[3]    R. C. Luo and C. C. Chen, "Quasi-natural Humanoid Robot Walking Trajectory Generator Based on Five-mass with Angular Momentum Model," IEEE Transactions on Industrial Electronics, Vol. 65, No. 4, pp. 3355-3364, 2017, doi: 10.1109/TIE.2017.2750628.
 
[4]    Y.-F. Ho, T.-H. S. Li, P.-H. Kuo, and Y.-T. Ye, "Parameterized Gait Pattern Generator Based on Linear Inverted Pendulum Model with Natural ZMP References," The Knowledge Engineering Review, Vol. 32, 2017, doi:10.1017/S0269888916000138.
 
[5]    C.-C. Wong, S.-R. Xiao, and H. Aoyama, "Natural Walking Trajectory Generator for Humanoid Robot Based on Three-mass LIPFM," IEEE Access, Vol. 8, pp. 228151-228162, 2020, doi: 10.1109/ACCESS.2020.3046106.
 
[6]    M. Vukobratović and B. Borovac, "Zero-moment Point—Thirty Five Years of Its Life," International Journal of Humanoid Robotics, Vol. 1, No. 01, pp. 157-173, 2004, https://doi.org/10.1142/S0219843604000083.
 
[7]    A. Goswami, "Foot Rotation Indicator (FRI) Point: A New Gait Planning Tool to Evaluate Postural Stability of Biped Robots," in Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No. 99CH36288C), 1999, Vol. 1, pp. 47-52: IEEE, doi: 10.1109/ROBOT.1999.769929.
 
[8]    Z. Zhang, L. Wang, J. Liao, J. Zhao, Z. Zhou, and X. Liu, "Dynamic Stability of Bio-inspired Biped Robots for Lateral Jumping in Rugged Terrain," Applied Mathematical Modelling, Vol. 97, pp. 113-137, 2021, https://doi.org/10.1016/j.apm.2021.03.050.
 
[9]    A. Takhmar, M. Alghooneh, K. Alipour, S. Ali, and A. Moosavian, "MHS Measure for Postural Stability Monitoring and Control of Biped Robots," in 2008 IEEE/ASME International Conference on Advanced Intelligent Mechatronics, 2008, pp. 400-405: IEEE, doi: 10.1109/AIM.2008.4601694.
 
[10]  H. Hirukawa et al., "A Universal Stability Criterion of the Foot contact of Legged Robots-adios Zmp," In Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006., 2006, pp. 1976-1983: IEEE, doi: 10.1109/ROBOT.2006.1641995 .
 
[11]  W. Z. Peng, C. Mummolo, and J. H. Kim, "Stability Criteria of Balanced and Steppable Unbalanced States for Full-body Systems with Implications in Robotic and Human Gait," in 2020 IEEE International Conference on Robotics and Automation (ICRA), 2020, pp. 9789-9795: IEEE, doi: 10.1109/ICRA40945.2020.9196820.
 
[12]  A. Goswami and P. Vadakkepat, Humanoid Robotics: A reference. Springer, 2019.
 
[13]  S. Kajita, F. Kanehiro, K. Kaneko, K. Yokoi, and H. Hirukawa, "The 3D Linear Inverted Pendulum Mode: A Simple Modeling for a Biped Walking Pattern Generation," In Proceedings 2001 IEEE/RSJ International Conference on Intelligent Robots and Systems. Expanding the Societal Role of Robotics in the the Next Millennium (Cat. No. 01CH37180), 2001, Vol. 1, pp. 239-246: IEEE, doi: 10.1109/IROS.2001.973365.
 
[14]  S. Kajita et al., "Biped Walking Pattern Generation by using Preview Control of Zero-moment Point," in 2003 IEEE International Conference on Robotics and Automation (Cat. No. 03CH37422), 2003, Vol. 2, pp. 1620-1626: IEEE, doi: 10.1109/ROBOT.2003.1241826.
 
[15]  A. Herdt, N. Perrin, and P.-B. Wieber, "Walking without Thinking About It," In 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems, 2010, pp. 190-195: IEEE, doi: 10.1109/IROS.2010.5654429.
 
[16]  M. S. Khan and R. K. Mandava, "A Review on Gait Generation of the Biped Robot on Various Terrains," Robotica, pp. 1-43, 2023, doi:10.1017/S0263574723000097.
 
[17]  C. Hu, S. Xie, L. Gao, S. Lu, and J. Li, "An Overview on Bipedal Gait Control Methods," IET Collaborative Intelligent Manufacturing, Vol. 5, No. 3, p. e12080, 2023, https://doi.org/10.1049/cim2.12080.
 
[18]  N. Ratre, S. Panigrahi, and S. Dubey, "Offline Trajectory Generation for Bipedal Robot using Linear Inverted Pendulum Model," Journal of Mechanical Materials and Mechanics Research| Volume, Vol. 6, No. 02, 2023.
 
[19]  N. Scianca, D. De Simone, L. Lanari, and G. Oriolo, "MPC for Humanoid Gait Generation: Stability and Feasibility," IEEE Transactions on Robotics, Vol. 36, No. 4, pp. 1171-1188, 2020, doi: 10.1109/TRO.2019.2958483.
 
[20]  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), 2019, pp. 25-32: IEEE, doi: 10.1109/Humanoids43949.2019.9035053.
 
[21]  R. Schuller, G. Mesesan, J. Englsberger, J. Lee, and C. Ott, "Online Learning of Centroidal Angular Momentum Towards Enhancing Dcm-based Locomotion," In 2022 International Conference on Robotics and Automation (ICRA), 2022, pp. 10442-10448: IEEE,  doi: 10.1109/Humanoids43949.2019.9035053.
 
[22]  M. Shafiee, G. Romualdi, S. Dafarra, F. J. A. Chavez, and D. Pucci, "Online Dcm Trajectory Generation for Push Recovery of Torque-controlled Humanoid Robots," In 2019 IEEE-RAS 19th International Conference on Humanoid Robots (Humanoids), 2019, pp. 671-678: IEEE, doi: 10.1109/Humanoids43949.2019.9034996.
 
[23]  N. Figueroa, J. Tafur and A. Kheddar, "Reinforcement Learning-based Parameter Optimization for Whole-body Admittance Control with IS-MPC," 2024 IEEE/SICE International Symposium on System Integration (SII), Ha Long, Vietnam, 2024, pp. 1405-1410, doi: 10.1109/SII58957.2024.10417367.
 
[24]  R. Mirjalili, A. Yousefi-Koma, F. A. Shirazi, and S. Mansouri, "Online Path Planning for SURENA III Humanoid Robot using Model Predictive Control Scheme," In 2016 4th International Conference on Robotics and Mechatronics (ICROM), 2016, pp. 416-421: IEEE, doi: 10.1109/ICRoM.2016.7886774.
 
[25]  M. Sadedel, A. Yousefi-koma, and M. Khadiv, "Offline Path Planning, Dynamic Modeling and Gait Optimization of a 2D Humanoid Robot," In 2014 Second RSI/ISM International Conference on Robotics and Mechatronics (ICRoM), 2014, pp. 131-136: IEEE, doi: 10.1109/ICRoM.2014.6990889.
 
[26]  M. Khadiv, S. A. A. Moosavian, A. Yousefi-Koma, H. Maleki, and M. Sadedel, "Online Adaptation for Humanoids Walking on Uncertain Surfaces," Proceedings of the Institution of Mechanical Engineers, Part I: Journal of Systems and Control Engineering, Vol. 231, No. 4, pp. 245-258, 2017, https://doi.org/10.1177/0959651817692484.
 
[27]  J. Pratt, J. Carff, S. Drakunov, and A. Goswami, "Capture Point: A Step Toward Humanoid Push Recovery," In 2006 6th IEEE-RAS International Conference on Humanoid Robots, 2006, pp. 200-207: IEEE, doi: 10.1109/ICHR.2006.321385.
 
[28]  T. Takenaka, T. Matsumoto, and T. Yoshiike, "Real Time Motion Generation and Control for Biped Robot-1 st Report: Walking Gait Pattern Generation," in 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems, 2009, pp. 1084-1091: IEEE, doi: 10.1109/IROS.2009.5354662.
 
[29]  J. Englsberger, G. Mesesan, and C. Ott, "Smooth Trajectory Generation and Push-recovery Based on Divergent Component of Motion," in 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), 2017, pp. 4560-4567: IEEE, doi: 10.1109/IROS.2017.8206324.
 
[30]  M. Khadiv, A. Herzog, S. A. A. Moosavian, and L. Righetti, "A Robust Walking Controller Based on Online Step Location and Duration Optimization for Bipedal Locomotion," arXiv Preprint arXiv:1704.01271, 2017, doi: 10.1109/TRO.2020.2982584.
 
[31]  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, https://doi.org/10.1016/j.robot.2018.12.003.
[32]  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, doi: 10.1109/TRO.2019.2926487.
 
[33]  M. Sadedel, A. Yousefi-Koma, M. Khadiv, and M. Mahdavian, "Adding Low-cost Passive Toe Joints to the Feet Structure of SURENA III Humanoid Robot," Robotica, Vol. 35, No. 11, pp. 2099-2121, 2017, doi:10.1017/S026357471600059X.
 
[34]  K. Harada, S. Kajita, K. Kaneko, and H. Hirukawa, "An Analytical Method for Real-time Gait Planning for Humanoid Robots," International Journal of Humanoid Robotics, Vol. 3, No. 01, pp. 1-19, 2006, https://doi.org/10.1142/S0219843606000643.
 
[35]  S. Kajita, H. Hirukawa, K. Harada, and K. Yokoi, Introduction to Humanoid Robotics. Springer, 2014, https://doi.org/10.1007/978-3-642-54536-8.

  • Receive Date 08 June 2022
  • Revise Date 17 February 2024
  • Accept Date 02 March 2024