One paper was accepted by ICRA 2024.