Make soft endstops truly soft