Papers
Topics
Authors
Recent
2000 character limit reached

DisCo: Distributed Contact-Rich Trajectory Optimization for Forceful Multi-Robot Collaboration (2410.23283v1)

Published 30 Oct 2024 in cs.RO, cs.SY, and eess.SY

Abstract: We present DisCo, a distributed algorithm for contact-rich, multi-robot tasks. DisCo is a distributed contact-implicit trajectory optimization algorithm, which allows a group of robots to optimize a time sequence of forces to objects and to their environment to accomplish tasks such as collaborative manipulation, robot team sports, and modular robot locomotion. We build our algorithm on a variant of the Alternating Direction Method of Multipliers (ADMM), where each robot computes its own contact forces and contact-switching events from a smaller single-robot, contact-implicit trajectory optimization problem, while cooperating with other robots through dual variables, enforcing constraints between robots. Each robot iterates between solving its local problem, and communicating over a wireless mesh network to enforce these consistency constraints with its neighbors, ultimately converging to a coordinated plan for the group. The local problems solved by each robot are significantly less challenging than a centralized problem with all robots' contact forces and switching events, improving the computational efficiency, while also preserving the privacy of some aspects of each robot's operation. We demonstrate the effectiveness of our algorithm in simulations of collaborative manipulation, multi-robot team sports scenarios, and in modular robot locomotion, where DisCo achieves $3$x higher success rates with a 2.5x to 5x faster computation time. Further, we provide results of hardware experiments on a modular truss robot, with three collaborating truss nodes planning individually while working together to produce a punctuated rolling-gate motion of the composite structure. Videos are available on the project page: https://disco-opt.github.io.

Definition Search Book Streamline Icon: https://streamlinehq.com
References (47)
  1. N. S. Usevitch, Z. M. Hammond, M. Schwager, A. M. Okamura, E. W. Hawkes, and S. Follmer, “An untethered isoperimetric soft robot,” Science Robotics, vol. 5, no. 40, p. eaaz0492, Mar. 2020. [Online]. Available: https://robotics.sciencemag.org/lookup/doi/10.1126/scirobotics.aaz0492
  2. O. Shorinwa, T. Halsted, and M. Schwager, “Scalable distributed optimization with separable variables in multi-agent networks,” in 2020 American Control Conference (ACC).   IEEE, 2020, pp. 3619–3626.
  3. O. Shorinwa and M. Schwager, “Distributed contact-implicit trajectory optimization for collaborative manipulation,” in 2021 International Symposium on Multi-Robot and Multi-Agent Systems (MRS).   IEEE, 2021, pp. 56–65.
  4. A. W. Winkler, C. D. Bellicoso, M. Hutter, and J. Buchli, “Gait and trajectory optimization for legged systems through phase-based end-effector parameterization,” IEEE Robotics and Automation Letters, vol. 3, no. 3, pp. 1560–1567, 2018.
  5. I. Mordatch, E. Todorov, and Z. Popović, “Discovery of complex behaviors through contact-invariant optimization,” ACM Transactions on Graphics (TOG), vol. 31, no. 4, pp. 1–8, 2012.
  6. J. Carpentier and N. Mansard, “Multicontact locomotion of legged robots,” IEEE Transactions on Robotics, vol. 34, no. 6, pp. 1441–1460, 2018.
  7. B. Aceituno-Cabezas, C. Mastalli, H. Dai, M. Focchi, A. Radulescu, D. G. Caldwell, J. Cappelletto, J. C. Grieco, G. Fernández-López, and C. Semini, “Simultaneous contact, gait, and motion planning for robust multilegged locomotion via mixed-integer convex optimization,” IEEE Robotics and Automation Letters, vol. 3, no. 3, pp. 2531–2538, 2017.
  8. D. Stewart and J. C. Trinkle, “An implicit time-stepping scheme for rigid body dynamics with coulomb friction,” in Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No. 00CH37065), vol. 1.   IEEE, 2000, pp. 162–169.
  9. J.-P. Sleiman, J. Carius, R. Grandia, M. Wermelinger, and M. Hutter, “Contact-implicit trajectory optimization for dynamic object manipulation,” in 2019 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).   IEEE, 2019, pp. 6814–6821.
  10. M. Posa, C. Cantu, and R. Tedrake, “A direct method for trajectory optimization of rigid bodies through contact,” The International Journal of Robotics Research, vol. 33, no. 1, pp. 69–81, 2014.
  11. Z. Zhou and Y. Zhao, “Accelerated admm based trajectory optimization for legged locomotion with coupled rigid body dynamics,” in 2020 American Control Conference (ACC).   IEEE, 2020, pp. 5082–5089.
  12. L. Drnach and Y. Zhao, “Robust trajectory optimization over uncertain terrain with stochastic complementarity,” IEEE Robotics and Automation Letters, vol. 6, no. 2, pp. 1168–1175, 2021.
  13. A. O. Onol, P. Long, and T. Padlr, “A comparative analysis of contact models in trajectory optimization for manipulation,” in 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).   IEEE, 2018, pp. 1–9.
  14. M. Neunert, F. Farshidian, A. W. Winkler, and J. Buchli, “Trajectory optimization through contacts and automatic gait discovery for quadrupeds,” IEEE Robotics and Automation Letters, vol. 2, no. 3, pp. 1502–1509, 2017.
  15. J. Carius, R. Ranftl, V. Koltun, and M. Hutter, “Trajectory optimization for legged robots with slipping motions,” IEEE Robotics and Automation Letters, vol. 4, no. 3, pp. 3013–3020, 2019.
  16. ——, “Trajectory optimization with implicit hard contacts,” IEEE Robotics and Automation Letters, vol. 3, no. 4, pp. 3316–3323, 2018.
  17. I. Chatzinikolaidis, Y. You, and Z. Li, “Contact-implicit trajectory optimization using an analytically solvable contact model for locomotion on variable ground,” IEEE Robotics and Automation Letters, vol. 5, no. 4, pp. 6357–6364, 2020.
  18. O. Shorinwa, T. Halsted, J. Yu, and M. Schwager, “Distributed optimization methods for multi-robot systems: Part 1—a tutorial,” IEEE Robotics & Automation Magazine, 2024.
  19. ——, “Distributed optimization methods for multi-robot systems: Part 2—a survey,” IEEE Robotics & Automation Magazine, 2024.
  20. T. Halsted, O. Shorinwa, J. Yu, and M. Schwager, “A survey of distributed optimization methods for multi-robot systems,” arXiv preprint arXiv:2103.12840, 2021.
  21. B. Hichri, L. Adouane, J.-C. Fauroux, Y. Mezouar, and I. Doroftei, “Cooperative mobile robot control architecture for lifting and transportation of any shape payload,” in Distributed Autonomous Robotic Systems.   Springer, 2016, pp. 177–191.
  22. A. Z. Bais, S. Erhart, L. Zaccarian, and S. Hirche, “Dynamic load distribution in cooperative manipulation tasks,” in 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).   IEEE, 2015, pp. 2380–2385.
  23. D. Ortenzi, R. Muthusamy, A. Freddi, A. Monteriù, and V. Kyrki, “Dual-arm cooperative manipulation under joint limit constraints,” Robotics and Autonomous Systems, vol. 99, pp. 110–120, 2018.
  24. A. Petitti, A. Franchi, D. Di Paola, and A. Rizzo, “Decentralized motion control for cooperative manipulation with a team of networked mobile manipulators,” in 2016 IEEE International Conference on Robotics and Automation (ICRA).   IEEE, 2016, pp. 441–446.
  25. Z. Wang and M. Schwager, “Force-amplifying n-robot transport system (force-ants) for cooperative planar manipulation without communication,” The International Journal of Robotics Research, vol. 35, no. 13, pp. 1564–1586, 2016.
  26. A. Marino and F. Pierri, “A two stage approach for distributed cooperative manipulation of an unknown object without explicit communication and unknown number of robots,” Robotics and Autonomous Systems, vol. 103, pp. 122–133, 2018.
  27. P. Culbertson and M. Schwager, “Decentralized adaptive control for collaborative manipulation,” in 2018 IEEE International Conference on Robotics and Automation (ICRA).   IEEE, 2018, pp. 278–285.
  28. I. Mas and C. Kitts, “Object manipulation using cooperative mobile multi-robot systems,” in Proceedings of the World Congress on Engineering and Computer Science, vol. 1, 2012.
  29. W. Wan, R. Fukui, M. Shimosaka, T. Sato, and Y. Kuniyoshi, “Cooperative manipulation with least number of robots via robust caging,” in 2012 IEEE/ASME International Conference on Advanced Intelligent Mechatronics (AIM).   IEEE, 2012, pp. 896–903.
  30. Y. Kobayashi and S. Hosoe, “Cooperative enclosing and grasping of an object by decentralized mobile robots using local observation,” International Journal of Social Robotics, vol. 4, no. 1, pp. 19–32, 2012.
  31. T. Stouraitis, I. Chatzinikolaidis, M. Gienger, and S. Vijayakumar, “Online hybrid motion planning for dyadic collaborative manipulation via bilevel optimization,” IEEE Transactions on Robotics, vol. 36, no. 5, pp. 1452–1471, 2020.
  32. C. K. Verginis, A. Nikou, and D. V. Dimarogonas, “Communication-based decentralized cooperative object transportation using nonlinear model predictive control,” in 2018 European control conference (ECC).   IEEE, 2018, pp. 733–738.
  33. O. Shorinwa and M. Schwager, “Scalable collaborative manipulation with distributed trajectory planning,” in 2020 Proceedings of IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).   IEEE, 2020, pp. 9108–9115.
  34. C. E. Garcia, D. M. Prett, and M. Morari, “Model predictive control: Theory and practice—a survey,” Automatica, vol. 25, no. 3, pp. 335–348, 1989.
  35. M. Schwenzer, M. Ay, T. Bergs, and D. Abel, “Review on model predictive control: An engineering perspective,” The International Journal of Advanced Manufacturing Technology, vol. 117, no. 5, pp. 1327–1349, 2021.
  36. T. P. Nascimento, C. E. Dórea, and L. M. G. Gonçalves, “Nonholonomic mobile robots’ trajectory tracking model predictive control: a survey,” Robotica, vol. 36, no. 5, pp. 676–696, 2018.
  37. O. Shorinwa and M. Schwager, “Distributed model predictive control via separable optimization in multiagent networks,” IEEE Transactions on Automatic Control, vol. 69, no. 1, pp. 230–245, 2023.
  38. G. Mateos, J. A. Bazerque, and G. B. Giannakis, “Distributed sparse linear regression,” IEEE Transactions on Signal Processing, vol. 58, no. 10, pp. 5262–5276, 2010.
  39. A. Nedic, A. Olshevsky, and W. Shi, “Achieving geometric convergence for distributed optimization over time-varying graphs,” SIAM Journal on Optimization, vol. 27, no. 4, pp. 2597–2633, 2017.
  40. W. Shi, Q. Ling, G. Wu, and W. Yin, “Extra: An exact first-order algorithm for decentralized consensus optimization,” SIAM Journal on Optimization, vol. 25, no. 2, pp. 944–966, 2015.
  41. C. Xi, R. Xin, and U. A. Khan, “Add-opt: Accelerated distributed directed optimization,” IEEE Transactions on Automatic Control, vol. 63, no. 5, pp. 1329–1339, 2017.
  42. M. Eisen, A. Mokhtari, and A. Ribeiro, “Decentralized quasi-newton methods,” IEEE Transactions on Signal Processing, vol. 65, no. 10, pp. 2613–2628, 2017.
  43. H. Liu, J. Zhang, A. M.-C. So, and Q. Ling, “A communication-efficient decentralized newton’s method with provably faster convergence,” IEEE Transactions on Signal and Information Processing over Networks, 2023.
  44. O. Shorinwa and M. Schwager, “Distributed quasi-newton method for multi-agent optimization,” arXiv preprint arXiv:2402.06778, 2024.
  45. Y. Wang, W. Yin, and J. Zeng, “Global convergence of admm in nonconvex nonsmooth optimization,” Journal of Scientific Computing, vol. 78, no. 1, pp. 29–63, 2019.
  46. A. Wächter and L. T. Biegler, “On the implementation of an interior-point filter line-search algorithm for large-scale nonlinear programming,” Mathematical programming, vol. 106, no. 1, pp. 25–57, 2006.
  47. G. Bradski, “The OpenCV Library,” Dr. Dobb’s Journal of Software Tools, 2000.

Summary

We haven't generated a summary for this paper yet.

Ai Sparkles Streamline Icon: https://streamlinehq.com Summarize Now
Slide Deck Streamline Icon: https://streamlinehq.com

Whiteboard

Dice Question Streamline Icon: https://streamlinehq.com

Open Problems

We haven't generated a list of open problems mentioned in this paper yet.

Ai Sparkles Streamline Icon: https://streamlinehq.com Generate Now
Lightbulb Streamline Icon: https://streamlinehq.com

Continue Learning

We haven't generated follow-up questions for this paper yet.

Ai Sparkles Streamline Icon: https://streamlinehq.com Generate Now
List To Do Tasks Checklist Streamline Icon: https://streamlinehq.com

Collections

Sign up for free to add this paper to one or more collections.

User Circle Single Streamline Icon: https://streamlinehq.com Sign Up
Github Logo Streamline Icon: https://streamlinehq.com

GitHub

  1. DisCo: Distributed Contact-Rich Trajectory Optimization for Forceful Multi-Robot Collaboration
X Twitter Logo Streamline Icon: https://streamlinehq.com

Tweets

This paper has been mentioned in 1 tweet and received 0 likes.

Upgrade to Pro to view all of the tweets about this paper:

Start a free 7-day Pro trial