G405 at startup and fix endstop enable

System will now Z-Max when Marlin starts

Also, the endstops were not disabled at the end of G405 for ENDSTOPS_FOR_HOMING_ONLY, this has been corrected