One paper accepted by IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2025).