Online Multi-Contact Feedback Model Predictive Control for Interactive Robotic Tasks (2403.08302v1)
Abstract: In this paper, we propose a model predictive control (MPC) that accomplishes interactive robotic tasks, in which multiple contacts may occur at unknown locations. To address such scenarios, we made an explicit contact feedback loop in the MPC framework. An algorithm called Multi-Contact Particle Filter with Exploration Particle (MCP-EP) is employed to establish real-time feedback of multi-contact information. Then the interaction locations and forces are accommodated in the MPC framework via a spring contact model. Moreover, we achieved real-time control for a 7 degrees of freedom robot without any simplifying assumptions by employing a Differential-Dynamic-Programming algorithm. We achieved 6.8kHz, 1.9kHz, and 1.8kHz update rates of the MPC for 0, 1, and 2 contacts, respectively. This allows the robot to handle unexpected contacts in real time. Real-world experiments show the effectiveness of the proposed method in various scenarios.
- M. Iskandar, C. Ott, A. Albu-Schäffer, B. Siciliano, and A. Dietrich, “Hybrid force-impedance control for fast end-effector motions,” IEEE Robotics and Automation Letters, vol. 8, no. 7, pp. 3931–3938, 2023.
- C. Ott, R. Mukherjee, and Y. Nakamura, “Unified impedance and admittance control,” in IEEE International Conference on Robotics and Automation (ICRA), 2010, pp. 554–561.
- M. J. Kim, F. Beck, C. Ott, and A. Albu-Schäffer, “Model-free friction observers for flexible joint robots with torque measurements,” IEEE Transactions on Robotics, vol. 35, no. 6, pp. 1508–1515, 2019.
- J. Jeong, H. Mishra, C. Ott, and M. J. Kim, “A memory-based SO(3) parameterization: Theory and application to 6D impedance control with radially unbounded potential function,” in IEEE International Conference on Robotics and Automation (ICRA), 2022, pp. 8338–8344.
- M. J. Kim, A. Werner, F. Loeffl, and C. Ott, “Passive impedance control of robots with viscoelastic joints via inner-loop torque control,” IEEE Transactions on Robotics, vol. 38, no. 1, pp. 584–598, 2022.
- M. J. Kim, W. Lee, C. Ott, and W. K. Chung, “A passivity-based admittance control design using feedback interconnections,” in IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), 2016, pp. 801–807.
- A. Q. Keemink, H. van der Kooij, and A. H. Stienen, “Admittance control for physical human–robot interaction,” The International Journal of Robotics Research, vol. 37, no. 11, pp. 1421–1444, 2018.
- M. J. Kim, W. Lee, J. Y. Choi, G. Chung, K.-L. Han, I. S. Choi, C. Ott, and W. K. Chung, “A passivity-based nonlinear admittance control with application to powered upper-limb control under unknown environmental interactions,” IEEE/ASME Transactions on Mechatronics, vol. 24, no. 4, pp. 1473–1484, 2019.
- Y. Tassa, T. Erez, and E. Todorov, “Synthesis and stabilization of complex behaviors through online trajectory optimization,” in IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), 2012, pp. 4906–4913.
- Y. Tassa, N. Mansard, and E. Todorov, “Control-limited differential dynamic programming,” in IEEE International Conference on Robotics and Automation (ICRA), 2014, pp. 1168–1175.
- C. Mastalli, W. Merkt, J. Marti-Saumell, H. Ferrolho, J. Solà, N. Mansard, and S. Vijayakumar, “A feasibility-driven approach to control-limited DDP,” Autonomous Robots, vol. 46, no. 8, pp. 985–1005, 2022.
- Y. Aoyama, G. Boutselis, A. Patel, and E. A. Theodorou, “Constrained differential dynamic programming revisited,” in IEEE International Conference on Robotics and Automation (ICRA), 2021, pp. 9738–9744.
- S. Kleff, E. Dantec, G. Saurel, N. Mansard, and L. Righetti, “Introducing force feedback in model predictive control,” in IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), 2022, pp. 13 379–13 385.
- C. Mastalli, R. Budhiraja, W. Merkt, G. Saurel, B. Hammoud, M. Naveau, J. Carpentier, L. Righetti, S. Vijayakumar, and N. Mansard, “Crocoddyl: An efficient and versatile framework for multi-contact optimal control,” in IEEE International Conference on Robotics and Automation (ICRA), 2020, pp. 2536–2542.
- K. J. Kazim, J. Bethge, J. Matschek, and R. Findeisen, “Combined predictive path following and admittance control,” in Annual American Control Conference (ACC), 2018, pp. 3153–3158.
- A. Wahrburg and K. Listmann, “MPC-based admittance control for robotic manipulators,” in IEEE 55th Conference on Decision and Control (CDC), 2016, pp. 7548–7554.
- M. Bednarczyk, H. Omran, and B. Bayle, “Model predictive impedance control,” in IEEE international conference on robotics and automation (ICRA), 2020, pp. 4702–4708.
- T. Gold, A. Völz, and K. Graichen, “Model predictive interaction control for industrial robots,” IFAC-PapersOnLine, vol. 53, no. 2, pp. 9891–9898, 2020.
- ——, “Model predictive position and force trajectory tracking control for robot-environment interaction,” in IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), 2020, pp. 7397–7402.
- ——, “Model predictive interaction control for robotic manipulation tasks,” IEEE Transactions on Robotics, vol. 39, no. 1, pp. 76–89, 2022.
- J. Matschek, J. Bethge, P. Zometa, and R. Findeisen, “Force feedback and path following using predictive control: Concept and application to a lightweight robot,” IFAC-PapersOnLine, vol. 50, no. 1, pp. 9827–9832, 2017.
- J. Matschek, R. Jordanowa, and R. Findeisen, “Direct force feedback using Gaussian process based model predictive control,” in IEEE Conference on Control Technology and Applications (CCTA), 2020, pp. 8–13.
- J. Matschek, J. Bethge, and R. Findeisen, “Safe machine-learning-supported model predictive force and motion control in robotics,” IEEE Transactions on Control Systems Technology, vol. 31, no. 6, pp. 2380–2392, 2023.
- M. Iskandar, O. Eiberger, A. Albu-Schäffer, A. De Luca, and A. Dietrich, “Collision detection, identification, and localization on the dlr sara robot with sensing redundancy,” in IEEE International Conference on Robotics and Automation (ICRA), 2021, pp. 3111–3117.
- L. Manuelli and R. Tedrake, “Localizing external contact using proprioceptive sensors: The contact particle filter,” in IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), 2016, pp. 5062–5069.
- S. W. Han and M. J. Kim, “Proprioceptive sensor-based simultaneous multi-contact point localization and force identification for robotic arms,” in IEEE International Conference on Robotics and Automation (ICRA), 2023, pp. 12 099–12 105.
- T. Pang and R. Tedrake, “Easing reliance on collision-free planning with contact-aware control,” in IEEE International Conference on Robotics and Automation (ICRA), 2022, pp. 8375–8381.
- A. Zube, J. Hofmann, and C. Frese, “Model predictive contact control for human-robot interaction,” in Proceedings of ISR: 47st International Symposium on Robotics. VDE, 2016, pp. 1–7.
- J. M. Gandarias, A. J. García-Cerezo, and J. M. Gómez-de Gabriel, “CNN-based methods for object recognition with high-resolution tactile sensors,” IEEE Sensors Journal, vol. 19, no. 16, pp. 6872–6882, 2019.
- J. Liang, J. Wu, H. Huang, W. Xu, B. Li, and F. Xi, “Soft sensitive skin for safety control of a nursing robot using proximity and tactile sensors,” IEEE Sensors Journal, vol. 20, no. 7, pp. 3822–3830, 2020.
- A. Jain, M. D. Killpack, A. Edsinger, and C. C. Kemp, “Reaching in clutter with whole-arm tactile sensing,” The International Journal of Robotics Research, vol. 32, no. 4, pp. 458–482, 2013.
- M. D. Killpack, A. Kapusta, and C. C. Kemp, “Model predictive control for fast reaching in clutter,” Autonomous Robots, vol. 40, pp. 537–560, 2016.
- J. Carpentier and N. Mansard, “Analytical derivatives of rigid body dynamics algorithms,” in Robotics: Science and systems (RSS), 2018.
- KAIST IRSL, “Multi-Contact Feedback MPC for interactive robotic tasks (ICRA2024),” (Feb. 27, 2024). Accessed: Feb. 27, 2024. [Online Video]. Available: https://youtu.be/pZbkHaxT1ao