Reviewed for IEEE Robotics and Automation Letters (RA-L) & IROS 2021