X. Lin, J. Ren, S. Coogan, Y. Zhao IEEE International Conference on Robotics and Automation, 2025, accepted