Additional tweaks to M42 exit conditions
This commit is contained in:
parent
4bbea5124d
commit
38b0082bf2
|
@ -3584,39 +3584,39 @@ inline void gcode_M31() {
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* M42: Change pin status via GCode
|
* M42: Change pin status via GCode
|
||||||
|
*
|
||||||
|
* P<pin> Pin number (LED if omitted)
|
||||||
|
* S<byte> Pin status from 0 - 255
|
||||||
*/
|
*/
|
||||||
inline void gcode_M42() {
|
inline void gcode_M42() {
|
||||||
if (code_seen('S')) {
|
if (code_seen('S')) {
|
||||||
int pin_status = code_value_short(),
|
int pin_status = code_value_short();
|
||||||
pin_number = LED_PIN;
|
if (pin_status < 0 || pin_status > 255) return;
|
||||||
|
|
||||||
if (code_seen('P') && pin_status >= 0 && pin_status <= 255)
|
int pin_number = code_seen('P') ? code_value_short() : LED_PIN;
|
||||||
pin_number = code_value_short();
|
if (pin_number < 0) return;
|
||||||
|
|
||||||
for (uint8_t i = 0; i < COUNT(sensitive_pins); i++) {
|
for (uint8_t i = 0; i < COUNT(sensitive_pins); i++)
|
||||||
if (sensitive_pins[i] == pin_number) {
|
if (pin_number == sensitive_pins[i]) return;
|
||||||
pin_number = -1;
|
|
||||||
break;
|
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
|
||||||
}
|
}
|
||||||
}
|
|
||||||
|
|
||||||
#if HAS_FAN0
|
|
||||||
if (pin_number == FAN_PIN) fanSpeeds[0] = pin_status;
|
|
||||||
#endif
|
#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);
|
|
||||||
}
|
|
||||||
} // code_seen('S')
|
} // code_seen('S')
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
Loading…
Reference in a new issue