Safety-Critical Coordination for Cooperative Legged Locomotion via Control Barrier Functions (2303.13630v2)
Abstract: This paper presents a safety-critical approach to the coordinated control of cooperative robots locomoting in the presence of fixed (holonomic) constraints. To this end, we leverage control barrier functions (CBFs) to ensure the safe cooperation of the robots while maintaining a desired formation and avoiding obstacles. The top-level planner generates a set of feasible trajectories, accounting for both kinematic constraints between the robots and physical constraints of the environment. This planner leverages CBFs to ensure safety-critical coordination control, i.e., guarantee safety of the collaborative robots during locomotion. The middle-level trajectory planner incorporates interconnected single rigid body (SRB) dynamics to generate optimal ground reaction forces (GRFs) to track the safety-ensured trajectories from the top-level planner while addressing the interconnection dynamics between agents. Distributed low-level controllers generate whole-body motion to follow the prescribed optimal GRFs while ensuring the friction cone condition at each end of the stance legs. The effectiveness of the approach is demonstrated through numerical simulations and experimentally on a pair of quadrupedal robots.
- P. Culbertson, J.-J. Slotine, and M. Schwager, “Decentralized adaptive control for collaborative manipulation of rigid bodies,” IEEE Transactions on Robotics, vol. 37, no. 6, pp. 1906–1920, 2021.
- T. Machado, T. Malheiro, S. Monteiro, W. Erlhagen, and E. Bicho, “Multi-constrained joint transportation tasks by teams of autonomous mobile robots using a dynamical systems approach,” in IEEE International Conference on Robotics and Automation, 2016, pp. 3111–3117.
- A. Tagliabue, M. Kamel, R. Siegwart, and J. Nieto, “Robust collaborative object transportation using multiple MAVs,” The International Journal of Robotics Research, vol. 38, no. 9, pp. 1020–1044, 2019.
- J. Wehbeh, S. Rahman, and I. Sharf, “Distributed model predictive control for UAVs collaborative payload transport,” in IEEE/RSJ International Conference on Intelligent Robots and Systems, 2020, pp. 11 666–11 672.
- J. Kim and K. Akbari Hamed, “Cooperative locomotion via supervisory predictive control and distributed nonlinear controllers,” Journal of Dynamic Systems, Measurement, and Control, vol. 144, no. 3, 2022.
- J. Kim, R. T. Fawcett, V. R. Kamidi, A. D. Ames, and K. A. Hamed, “Layered control for cooperative locomotion of two quadrupedal robots: Centralized and distributed approaches,” arXiv preprint arXiv:2211.06913, 2022.
- R. T. Fawcett, L. Amanzadeh, J. Kim, A. D. Ames, and K. A. Hamed, “Distributed data-driven predictive control for multi-agent collaborative legged locomotion,” arXiv preprint arXiv:2211.06917, 2022.
- A. D. Ames, X. Xu, J. W. Grizzle, and P. Tabuada, “Control barrier function based quadratic programs for safety critical systems,” IEEE Transactions on Automatic Control, vol. 62, no. 8, pp. 3861–3876, 2016.
- A. D. Ames, S. Coogan, M. Egerstedt, G. Notomista, K. Sreenath, and P. Tabuada, “Control barrier functions: Theory and applications,” in 2019 18th European control conference (ECC). IEEE, 2019, pp. 3420–3431.
- L. Wang, A. D. Ames, and M. Egerstedt, “Safety barrier certificates for collisions-free multirobot systems,” IEEE Transactions on Robotics, vol. 33, no. 3, pp. 661–674, 2017.
- S. Zhao and Z. Sun, “Defend the practicality of single-integrator models in multi-robot coordination control,” in 2017 13th IEEE International Conference on Control & Automation (ICCA). IEEE, 2017, pp. 666–671.
- D. Pickem, P. Glotfelter, L. Wang, M. Mote, A. Ames, E. Feron, and M. Egerstedt, “The robotarium: A remotely accessible swarm robotics research testbed,” in 2017 IEEE International Conference on Robotics and Automation (ICRA). IEEE, 2017, pp. 1699–1706.
- Y. Chen, A. Singletary, and A. D. Ames, “Guaranteed obstacle avoidance for multi-robot operations with limited actuation: A control barrier function approach,” IEEE Control Systems Letters, vol. 5, no. 1, pp. 127–132, 2020.
- E. Squires, R. Konda, S. Coogan, and M. Egerstedt, “Model free barrier functions via implicit evading maneuvers,” arXiv preprint arXiv:2107.12871, 2021.
- T. G. Molnar, R. K. Cosner, A. W. Singletary, W. Ubellacker, and A. D. Ames, “Model-free safety-critical control for robotic systems,” IEEE robotics and automation letters, vol. 7, no. 2, pp. 944–951, 2021.
- S. Singh, M. Chen, S. L. Herbert, C. J. Tomlin, and M. Pavone, “Robust tracking with model mismatch for fast and safe planning: an sos optimization approach,” in Algorithmic Foundations of Robotics XIII: Proceedings of the 13th Workshop on the Algorithmic Foundations of Robotics 13. Springer, 2020, pp. 545–564.
- R. Grandia, A. J. Taylor, A. D. Ames, and M. Hutter, “Multi-layered safety for legged robots via control barrier functions and model predictive control,” in 2021 IEEE International Conference on Robotics and Automation (ICRA). IEEE, 2021, pp. 8352–8358.
- C. Khazoom, D. Gonzalez-Diaz, Y. Ding, and S. Kim, “Humanoid self-collision avoidance using whole-body control with control barrier functions,” in 2022 IEEE-RAS 21st International Conference on Humanoid Robots (Humanoids). IEEE, 2022, pp. 558–565.
- E. D. Sontag, “Control-lyapunov functions,” Open problems in mathematical systems and control theory, pp. 211–216, 1999.
- S. Kolathaya and A. D. Ames, “Input-to-state safety with control barrier functions,” IEEE control systems letters, vol. 3, no. 1, pp. 108–113, 2018.
- Y. Ding, A. Pandala, C. Li, Y.-H. Shin, and H.-W. Park, “Representation-free model predictive control for dynamic motions in quadrupeds,” IEEE Transactions on Robotics, vol. 37, no. 4, pp. 1154–1171, 2021.
- M. Chignoli and P. M. Wensing, “Variational-based optimal control of underactuated balancing for dynamic quadrupeds,” IEEE Access, vol. 8, pp. 49 785–49 797, 2020.
- K. A. Hamed, J. Kim, and A. Pandala, “Quadrupedal locomotion via event-based predictive control and qp-based virtual constraints,” IEEE Robotics and Automation Letters, vol. 5, no. 3, pp. 4463–4470, 2020.
- M. H. Raibert, H. B. Brown Jr, M. Chepponis, J. Koechling, and J. K. Hodgins, “Dynamically stable legged locomotion,” Massachusetts Inst of Tech Cambridge Artificial Intelligence Lab, Tech. Rep., 1989.
- A. G. Pandala, Y. Ding, and H.-W. Park, “qpswift: A real-time sparse quadratic program solver for robotic applications,” IEEE Robotics and Automation Letters, vol. 4, no. 4, pp. 3355–3362, 2019.
- J. Hwangbo, J. Lee, and M. Hutter, “Per-contact iteration method for solving contact dynamics,” IEEE Robotics and Automation Letters, vol. 3, no. 2, pp. 895–902, 2018.
- Safety-critical coordination for cooperative legged locomotion via control barrier functions. [Online]. Available: https://vimeo.com/803721560/bd1871402a.
- Jeeseop Kim (16 papers)
- Jaemin Lee (26 papers)
- Aaron D. Ames (201 papers)