Unified Control Framework for Real-Time Interception and Obstacle Avoidance of Fast-Moving Objects with Diffusion Variational Autoencoder (2209.13628v2)
Abstract: Real-time interception of fast-moving objects by robotic arms in dynamic environments poses a formidable challenge due to the need for rapid reaction times, often within milliseconds, amidst dynamic obstacles. This paper introduces a unified control framework to address the above challenge by simultaneously intercepting dynamic objects and avoiding moving obstacles. Central to our approach is using diffusion-based variational autoencoder for motion planning to perform both object interception and obstacle avoidance. We begin by encoding the high-dimensional temporal information from streaming events into a two-dimensional latent manifold, enabling the discrimination between safe and colliding trajectories, culminating in the construction of an offline densely connected trajectory graph. Subsequently, we employ an extended Kalman filter to achieve precise real-time tracking of the moving object. Leveraging a graph-traversing strategy on the established offline dense graph, we generate encoded robotic motor control commands. Finally, we decode these commands to enable real-time motion of robotic motors, ensuring effective obstacle avoidance and high interception accuracy of fast-moving objects. Experimental validation on both computer simulations and autonomous 7-DoF robotic arms demonstrates the efficacy of our proposed framework. Results indicate the capability of the robotic manipulator to navigate around multiple obstacles of varying sizes and shapes while successfully intercepting fast-moving objects thrown from different angles by hand. Complete video demonstrations of our experiments can be found in https://sites.google.com/view/multirobotskill/home.
- M. Q. Mohammed, S. C. Chua, and L. C. Kwek, “Comprehensive review on reaching and grasping of objects in robotics,” Robotica, vol. 39, pp. 1849 – 1882, 2021. [Online]. Available: https://api.semanticscholar.org/CorpusID:234067726
- A. Dastider, H. Fang, and M. Lin, “Retro: Reactive trajectory optimization for real-time robot motion planning in dynamic environments,” arXiv preprint arXiv:2310.01738, 2023.
- S. Kim, A. Shukla, and A. Billard, “Catching objects in flight,” IEEE Transactions on Robotics, vol. 30, no. 5, pp. 1049–1065, 2014.
- N. Marturi et al., “Dynamic grasp and trajectory planning for moving objects,” Autonomous Robots, vol. 43, no. 5, p. 1241–1256, Aug. 2018. [Online]. Available: http://dx.doi.org/10.1007/s10514-018-9799-1
- J. R. Sánchez-Ibáñez et al., “Path planning for autonomous mobile robots: A review,” Sensors, vol. 21, no. 23, 2021. [Online]. Available: https://www.mdpi.com/1424-8220/21/23/7898
- D. Falanga, S. Kim, and D. Scaramuzza, “How fast is too fast? the role of perception latency in high-speed sense and avoid,” IEEE Robotics and Automation Letters, vol. 4, no. 2, pp. 1884–1891, 2019.
- S. M. LaValle, “Rapidly-exploring random trees : a new tool for path planning,” The annual research report, 1998. [Online]. Available: https://api.semanticscholar.org/CorpusID:14744621
- O. Salzman and D. Halperin, “Asymptotically near-optimal rrt for fast, high-quality motion planning,” IEEE Transactions on Robotics, vol. 32, no. 3, pp. 473–483, 2016.
- C. Zito et al., “Two-level rrt planning for robotic push manipulation,” in 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems, 2012, pp. 678–685.
- B. Ichter and M. Pavone, “Robot motion planning in learned latent spaces,” IEEE Robotics and Automation Letters, vol. 4, no. 3, pp. 2407–2414, 2019.
- A. H. Qureshi et al., “Motion planning networks: Bridging the gap between learning-based and classical motion planners,” IEEE Transactions on Robotics, vol. 37, no. 1, pp. 48–66, 2021.
- O. Adiyatov and H. A. Varol, “A novel rrt*-based algorithm for motion planning in dynamic environments,” in 2017 IEEE International Conference on Mechatronics and Automation, 2017, pp. 1416–1421.
- K. Wei and B. Ren, “A method on dynamic path planning for robotic manipulator autonomous obstacle avoidance based on an improved rrt algorithm,” Sensors, vol. 18, no. 2, 2018. [Online]. Available: https://www.mdpi.com/1424-8220/18/2/571
- S. M. Khansari-Zadeh and A. Billard, “A dynamical system approach to realtime obstacle avoidance,” Autonomous Robots, vol. 32, no. 4, pp. 433–454, 2012.
- S. Stavridis, D. Papageorgiou, and Z. Doulgeri, “Dynamical system based robotic motion generation with obstacle avoidance,” IEEE Robotics and Automation Letters, vol. 2, no. 2, pp. 712–718, 2017.
- R. Raveendran, A. D. Mahindrakar, and U. Vaidya, “Dynamical system approach for time-varying constrained convex optimization problems,” IEEE Transactions on Automatic Control, 2023.
- A. Amiranashvili et al., “Motion perception in reinforcement learning with dynamic objects,” in Proceedings of The 2nd Conference on Robot Learning, ser. Proceedings of Machine Learning Research, A. Billard, A. Dragan, J. Peters, and J. Morimoto, Eds., vol. 87. PMLR, 29–31 Oct 2018, pp. 156–168. [Online]. Available: https://proceedings.mlr.press/v87/amiranashvili18a.html
- D. Hafner et al., “Learning latent dynamics for planning from pixels,” in Proceedings of the 36th International Conference on Machine Learning, ser. Proceedings of Machine Learning Research, K. Chaudhuri and R. Salakhutdinov, Eds., vol. 97. PMLR, 09–15 Jun 2019, pp. 2555–2565. [Online]. Available: https://proceedings.mlr.press/v97/hafner19a.html
- C. Zhou, B. Huang, and P. Fränti, “A review of motion planning algorithms for intelligent robots,” Journal of Intelligent Manufacturing, vol. 33, no. 2, p. 387–424, Nov. 2021. [Online]. Available: http://dx.doi.org/10.1007/s10845-021-01867-z
- H. B. Mohammadi et al., “Learning riemannian manifolds for geodesic motion skills,” in Robotics: Science and Systems, 2021. [Online]. Available: https://doi.org/10.15607/RSS.2021.XVII.082
- A. Dastider and M. Lin, “Damon: Dynamic amorphous obstacle navigation using topological manifold learning and variational autoencoding,” in 2023 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), 2023, pp. 251–258.
- Q. Wu et al., “Handling distribution shifts on graphs: An invariance perspective,” arXiv preprint arXiv:2202.02466, 2022.
- D. Carneiro, F. Silva, and P. Georgieva, “Robot anticipation learning system for ball catching,” Robotics, vol. 10, no. 4, 2021. [Online]. Available: https://www.mdpi.com/2218-6581/10/4/113
- L. Dong et al., “A review of mobile robot motion planning methods: from classical motion planning workflows to reinforcement learning-based architectures,” Journal of Systems Engineering and Electronics, vol. 34, no. 2, pp. 439–459, 2023.
- B. Ivanovic et al., “Multimodal deep generative models for trajectory prediction: A conditional variational autoencoder approach,” IEEE Robotics and Automation Letters, vol. 6, no. 2, pp. 295–302, 2021.
- M. Noseworthy et al., “Task-conditioned variational autoencoders for learning movement primitives,” in Proceedings of the Conference on Robot Learning, ser. Proceedings of Machine Learning Research, L. P. Kaelbling, D. Kragic, and K. Sugiura, Eds., vol. 100. PMLR, 30 Oct–01 Nov 2020, pp. 933–944. [Online]. Available: https://proceedings.mlr.press/v100/noseworthy20a.html
- C. Urrea and R. Agramonte, “Kalman filter: Historical overview and review of its use in robotics 60 years after its creation,” Journal of Sensors, vol. 2021, p. 1–21, Sep. 2021. [Online]. Available: http://dx.doi.org/10.1155/2021/9674015
- X. Li et al., “Applications of nbsp;kalman filtering in nbsp;time series prediction,” in Intelligent Robotics and Applications: 15th International Conference, ICIRA 2022, Harbin, China, August 1–3, 2022, Proceedings, Part III. Berlin, Heidelberg: Springer-Verlag, 2022, p. 520–531. [Online]. Available: https://doi.org/10.1007/978-3-031-13835-5_47
- H. Fang and Y. Yang, “Predictive neuromodulation of cingulo-frontal neural dynamics in major depressive disorder using a brain-computer interface system: A simulation study,” Frontiers in Computational Neuroscience, vol. 17, p. 1119685, 2023.
- H. Fang et al., “Robust adaptive deep brain stimulation control of non-stationary cortex-basal ganglia-thalamus network models in parkinson’s disease,” bioRxiv, pp. 2023–08, 2023.
- M. Khodarahmi and V. Maihami, “A review on kalman filter models,” Archives of Computational Methods in Engineering, vol. 30, no. 1, p. 727–747, Oct. 2022. [Online]. Available: http://dx.doi.org/10.1007/s11831-022-09815-7
- H. Li et al., “Variational diffusion autoencoders with random walk sampling,” in ECCV, 2020.
- J. De la Porte et al., “An introduction to diffusion maps,” in Proceedings of the 19th symposium of the pattern recognition association of South Africa (PRASA 2008), Cape Town, South Africa, 2008, pp. 15–25.
- S. Hong, J. Lu, and D. P. Filev, “Dynamic diffusion maps-based path planning for real-time collision avoidance of mobile robots,” in 2018 IEEE Intelligent Vehicles Symposium (IV), 2018, pp. 2224–2229.
- O. Kupervasser et al., “Using diffusion map for visual navigation of a ground robot,” Mathematics, vol. 8, no. 12, 2020. [Online]. Available: https://www.mdpi.com/2227-7390/8/12/2175
- A. A. Oliva et al., “Towards dynamic visual servoing for interaction control and moving targets,” in 2022 International Conference on Robotics and Automation (ICRA), 2022, pp. 150–156.
- S. J. Julier and J. K. Uhlmann, “New extension of the kalman filter to nonlinear systems,” in Defense, Security, and Sensing, 1997.
- P. Corke and J. Haviland, “Not your grandmother’s toolbox – the robotics toolbox reinvented for python,” in 2021 IEEE International Conference on Robotics and Automation (ICRA), 2021, pp. 11 357–11 363.
- Y. Zhang et al., “Fsgraph: fast and scalable implementation of graph traversal on gpus,” CCF Transactions on High Performance Computing, vol. 5, pp. 277 – 291, 2023. [Online]. Available: https://api.semanticscholar.org/CorpusID:259011375
- H. Fang and Y. Yang, “Designing and validating a robust adaptive neuromodulation algorithm for closed-loop control of brain states,” Journal of Neural Engineering, vol. 19, no. 3, p. 036018, 2022.
- O. M. Andrychowicz et al., “Learning dexterous in-hand manipulation,” The International Journal of Robotics Research, vol. 39, no. 1, pp. 3–20, 2020. [Online]. Available: https://doi.org/10.1177/0278364919887447
- Y. Zhao et al., “Intelligent control of multilegged robot smooth motion: A review,” IEEE Access, vol. 11, pp. 86 645–86 685, 2023.