BUGFIX to gantry-homing of usb_homing.c