Fixed docking, re-added homing, fixed some minor issues