Another minor use case bug where a robot switches goals multiple times need to track their current goal