Fix Engage/Retract servo endstops

"SERVO_ENDSTOPS[axis]" leads to compilation error, it should be "servo_endstops[axis]"