hfn: Ensure robot's pose is valid when it or map is updated

Perform spiral search from current pose to nearest cell that is safe
Fix another turning bug in hfn
Make localization launch file stand alone
Get scarab launch file working with new experiments
Add scripts for commanding robots with hfn