Additional tweaks to M42 exit conditions

This commit is contained in:
Scott Lahteine 2016-03-06 02:20:03 -08:00
parent 4bbea5124d
commit 38b0082bf2

View file

@ -3584,39 +3584,39 @@ inline void gcode_M31() {
/**
* M42: Change pin status via GCode
*
* P<pin> Pin number (LED if omitted)
* S<byte> Pin status from 0 - 255
*/
inline void gcode_M42() {
if (code_seen('S')) {
int pin_status = code_value_short(),
pin_number = LED_PIN;
int pin_status = code_value_short();
if (pin_status < 0 || pin_status > 255) return;
if (code_seen('P') && pin_status >= 0 && pin_status <= 255)
pin_number = code_value_short();
int pin_number = code_seen('P') ? code_value_short() : LED_PIN;
if (pin_number < 0) return;
for (uint8_t i = 0; i < COUNT(sensitive_pins); i++) {
if (sensitive_pins[i] == pin_number) {
pin_number = -1;
break;
}
}
for (uint8_t i = 0; i < COUNT(sensitive_pins); i++)
if (pin_number == sensitive_pins[i]) return;
#if HAS_FAN0
if (pin_number == FAN_PIN) fanSpeeds[0] = pin_status;
#endif
#if HAS_FAN1
if (pin_number == FAN1_PIN) fanSpeeds[1] = pin_status;
#endif
#if HAS_FAN2
if (pin_number == FAN2_PIN) fanSpeeds[2] = pin_status;
#endif
if (pin_number > -1) {
pinMode(pin_number, OUTPUT);
digitalWrite(pin_number, pin_status);
analogWrite(pin_number, pin_status);
#if FAN_COUNT > 0
switch (pin_number) {
#if HAS_FAN0
case FAN_PIN: fanSpeeds[0] = pin_status; break;
#endif
#if HAS_FAN1
case FAN1_PIN: fanSpeeds[1] = pin_status; break;
#endif
#if HAS_FAN2
case FAN2_PIN: fanSpeeds[2] = pin_status; break;
#endif
}
#endif
} // code_seen('S')
}