Disable safety only for docking.
Crappy fallback for auto-docking (go back a bit and retry after timeout).
Clear costmaps after relocalization so we can use the virtual sensor as it is now.
To allow this, navigator is now a singleton.
Give waiterbot more priority to allow auto-dock recovery