Safe motion planning and formation control of quadruped robots

Abstract

This paper introduces a motion planning and cooperative formation control approach for quadruped robots and multi-agent systems. First, in order to improve the efficiency and safety of quadruped robots navigating in complex environments, this paper proposes a new planning method that combines the dynamic model of quadruped robots and a gradient-optimized obstacle avoidance strategy without Euclidean Signed Distance Field. The framework is suitable for both static and slow dynamic obstacle environments, aiming to achieve multiple goals of obstacle avoidance, minimizing energy consumption, reducing impact, satisfying dynamic constraints, and ensuring trajectory smoothness. This approach differs in that it reduces energy consumption throughout the movement from a new perspective. Meanwhile, this method effectively reduces the impact of the ground on the robot, thus mitigating the damage to its structure. Second, we combine the dynamic control barrier function and the virtual leader-follower model to achieve efficient and safe formation control through model predictive control. Finally, the proposed algorithm is validated through both simulations and real-world scenarios testing.

References

[1.] YasudaY.D.V., MartinsL.E.G., CappabiancoF.A.M.. Autonomous visual navigation for mobile robots: a systematic literature review. ACM Comput. Surv., 2020, 53(1): 1-34

[2.] WangJ., HongY., WangJ., et al. . Cooperative and competitive multi-agent systems: from optimization to games. IEEE/CAA J. Autom. Sin., 2022, 9(5): 763-783

[3.] CarpentierJ., WieberP.B.. Recent progress in legged robots locomotion control. Curr. Robot. Rep., 2021, 2(3): 231-238

[4.] CuiL., WangS., ZhangJ., et al. . Learning-based balance control of wheel-legged robots. IEEE Robot. Autom. Lett., 2021, 6(4): 7667-7674

[5.] HutterM., GehringC., LauberA., et al. . Anymal-toward legged robots for harsh environments. Adv. Robot., 2017, 31(17): 918-931

[6.] MastalliC., HavoutisI., FocchiM., et al. . Motion planning for quadrupedal locomotion: coupled planning, terrain mapping, and whole-body control. IEEE Trans. Robot., 2020, 36(6): 1635-1648

[7.] KangW., LeeC., OhS.. Development of rotating workspace ground contact force observer for legged robot. 2021 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), 2021 7410-7415

[8.] KatzB., Di CarloJ., MiniK.S.. cheetah: a platform for pushing the limits of dynamic quadruped control. 2019 International Conference on Robotics and Automation (ICRA), 2019 6295-6301

[9.] NarayananS.S.K.S., ZhengA., VaidyaU.. Safe motion planning for quadruped robots using density functions. 2023 Ninth Indian Control Conference (ICC), 2023 263-268

[10.] LiQ., QianL., SunP., et al. . Energy-efficient dynamic motion planning of quadruped robots via whole-body nonlinear trajectory optimization. 2022 IEEE International Conference on Mechatronics and Automation (ICMA), 2022 1610-1615

[11.] QuanL., HanL., ZhouB., et al. . Survey of UAV motion planning. IET Cyber-Syst. Robot., 2020, 2(1): 14-21

[12.] UsenkoV., Von StumbergL., PangercicA., et al. . Real-time trajectory replanning for MAVs using uniform B-splines and a 3D circular buffer. 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), 2017 215-222

[13.] ZhouX., WangZ., YeH., et al. . Ego-planner: an esdf-free gradient-based local planner for quadrotors. IEEE Robot. Autom. Lett., 2020, 6(2): 478-485

[14.] VinodA.P., SafaouiS., ChakrabartyA., et al. . Safe multi-agent motion planning via filtered reinforcement learning. 2022 International Conference on Robotics and Automation (ICRA), 2022 7270-7276

[15.] SunY.Z., WuD., GaoL., et al. . Safety-critical control and path following by formations of agents with control barrier functions using distributed model predictive control. 2023 35th Chinese Control and Decision Conference (CCDC), 2023 1818-1823

[16.] MuntwilerS., WabersichK.P., CarronA., et al. . Distributed model predictive safety certification for learning-based control. IFAC-PapersOnLine, 2020, 53(2): 5258-5265

[17.] KargB., LuciaS.. Efficient representation and approximation of model predictive control laws via deep learning. IEEE Trans. Cybern., 2020, 50(9): 3866-3878

[18.] ChenB., BaiR., LiJ., et al. . A multiobjective single bus corridor scheduling using machine learning-based predictive models. Int. J. Prod. Res., 2023, 61(1): 131-145

[19.] BerberichJ., KöhlerJ., MüllerM.A., et al. . Data-driven model predictive control with stability and robustness guarantees. IEEE Trans. Autom. Control, 2020, 66(4): 1702-1717

[20.] KargB., LuciaS.. Efficient representation and approximation of model predictive control laws via deep learning. IEEE Trans. Cybern., 2020, 50(9): 3866-3878

[21.] ZengJ., ZhangB., SreenathK.. Safety-critical model predictive control with discrete-time control barrier function. 2021 American Control Conference (ACC), 2021 3882-3889

[22.] ZengJ., LiZ., SreenathK.. Enhancing feasibility and safety of nonlinear model predictive control with discrete-time control barrier functions. 2021 60th IEEE Conference on Decision and Control (CDC), 2021 6137-6144

[23.] JianZ., YanZ., LeiX., et al. . Dynamic control barrier function-based model predictive control to safety-critical obstacle-avoidance of mobile robot. 2023 IEEE International Conference on Robotics and Automation (ICRA), 2023 3679-3685

[24.] Di CarloJ., WensingP.M., KatzB., et al. . Dynamic locomotion in the mit cheetah 3 through convex model-predictive control. 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), 2018 1-9

[25.] FocchiM., Del PreteA., HavoutisI., et al. . High-slope terrain locomotion for torque-controlled quadruped robots. Auton. Robots, 2017, 4(1): 259-272

[26.] ZhangZ., YanJ., KongX., et al. . Efficient motion planning based on kinodynamic model for quadruped robots following persons in confined spaces. IEEE/ASME Trans. Mechatron., 2021, 26(4): 1997-2006

[27.] ZhouB., GaoF., WangL., et al. . Robust and efficient quadrotor trajectory generation for fast autonomous flight. IEEE Robot. Autom. Lett., 2019, 4(4): 3529-3536

[28.] GaoF., WangL., ZhouB., et al. . Teach-repeat-replan: a complete and robust system for aggressive flight in complex environments. IEEE Trans. Robot., 2020, 36(5): 1526-1545

[29.] WangP., ZhouX., ZhaoQ., et al. . Search-based kinodynamic motion planning for omnidirectional quadruped robots. 2021 IEEE/ASME International Conference on Advanced Intelligent Mechatronics (AIM), 2021 823-829

[30.] ShiH., WangM., WangC.. Leader–follower formation learning control of discrete-time nonlinear multiagent systems. IEEE Trans. Cybern., 2021, 53(2): 1184-1194

[31.] HuJ., BhowmickP., ArvinF., et al. . Cooperative control of heterogeneous connected vehicle platoons: an adaptive leader-following approach. IEEE Robot. Autom. Lett., 2020, 5(2): 977-984

[32.] BajalE., KataraV., BhatiaM., et al. . A review of clustering algorithms: comparison of DBSCAN and K-mean with oversampling and t-SNE. Recent Pat. Eng., 2022, 16(2): 17-31

[33.] YangY., QianC., LiH., et al. . An efficient DBSCAN optimized by arithmetic optimization algorithm with opposition-based learning. J. Supercomput., 2022, 78(18): 19566-19604

[34.] LiQ., WangZ., WangW., et al. . A model predictive obstacle avoidance method based on dynamic motion primitives and a Kalman filter. Asian J. Control, 2023, 25(2): 1510-1525

[35.] GuoY., LiW., XiaoL., et al. . A prediction-based iterative Kuhn-Munkres approach for service vehicle reallocation in ride-hailing. Int. J. Prod. Res., 2024, 62(10): 3690-3715

[36.] ZengJ., ZhangB., SreenathK.. Safety-critical model predictive control with discrete-time control barrier function. 2021 American Control Conference (ACC), 2021 3882-3889

[37.] AmesA.D., CooganS., EgerstedtM., et al. . Control barrier functions: theory and applications. 2019 18th European Control Conference (ECC), 2019 3420-3431

Funding

Shanghai Rising-Star Program(22QA1409400); National Natural Science Foundation of China(62088101); Fundamental Research Funds for the Central Universities(08002150223); Science and Technology Commission of Shanghai Municipality(2021SHZDZX0100)