Changes to get feijoa demo working with 621-outside map#7

NishanthJKumar wants to merge 7 commits intomainLearning-and-Intelligent-Systems/see-spot-plan:mainfrom

spot-planning-hackingLearning-and-Intelligent-Systems/see-spot-plan:spot-planning-hackingCopy head branch name to clipboard