Our paper submitted to 2024 IROS got accepted!