|
@ -40,11 +40,11 @@ |
|
|
#include "language.h" |
|
|
#include "language.h" |
|
|
#include "pins_arduino.h" |
|
|
#include "pins_arduino.h" |
|
|
|
|
|
|
|
|
#if (defined NUM_SERVOS) && (NUM_SERVOS > 0) |
|
|
#if NUM_SERVOS > 0 |
|
|
#include "Servo.h" |
|
|
#include "Servo.h" |
|
|
#endif |
|
|
#endif |
|
|
|
|
|
|
|
|
#if DIGIPOTSS_PIN > -1 |
|
|
#if DIGIPOTSS_PIN > 0 |
|
|
#include <SPI.h> |
|
|
#include <SPI.h> |
|
|
#endif |
|
|
#endif |
|
|
|
|
|
|
|
@ -230,7 +230,7 @@ static uint8_t tmp_extruder; |
|
|
|
|
|
|
|
|
bool Stopped=false; |
|
|
bool Stopped=false; |
|
|
|
|
|
|
|
|
#if (defined NUM_SERVOS) && (NUM_SERVOS > 0) |
|
|
#if NUM_SERVOS > 0 |
|
|
Servo servos[NUM_SERVOS]; |
|
|
Servo servos[NUM_SERVOS]; |
|
|
#endif |
|
|
#endif |
|
|
|
|
|
|
|
@ -309,7 +309,7 @@ void setup_killpin() |
|
|
void setup_photpin() |
|
|
void setup_photpin() |
|
|
{ |
|
|
{ |
|
|
#ifdef PHOTOGRAPH_PIN |
|
|
#ifdef PHOTOGRAPH_PIN |
|
|
#if (PHOTOGRAPH_PIN > -1) |
|
|
#if (PHOTOGRAPH_PIN > 0) |
|
|
SET_OUTPUT(PHOTOGRAPH_PIN); |
|
|
SET_OUTPUT(PHOTOGRAPH_PIN); |
|
|
WRITE(PHOTOGRAPH_PIN, LOW); |
|
|
WRITE(PHOTOGRAPH_PIN, LOW); |
|
|
#endif |
|
|
#endif |
|
@ -324,7 +324,7 @@ void setup_powerhold() |
|
|
WRITE(SUICIDE_PIN, HIGH); |
|
|
WRITE(SUICIDE_PIN, HIGH); |
|
|
#endif |
|
|
#endif |
|
|
#endif |
|
|
#endif |
|
|
#if (PS_ON_PIN > -1) |
|
|
#if (PS_ON_PIN > 0) |
|
|
SET_OUTPUT(PS_ON_PIN); |
|
|
SET_OUTPUT(PS_ON_PIN); |
|
|
WRITE(PS_ON_PIN, PS_ON_AWAKE); |
|
|
WRITE(PS_ON_PIN, PS_ON_AWAKE); |
|
|
#endif |
|
|
#endif |
|
@ -333,7 +333,7 @@ void setup_powerhold() |
|
|
void suicide() |
|
|
void suicide() |
|
|
{ |
|
|
{ |
|
|
#ifdef SUICIDE_PIN |
|
|
#ifdef SUICIDE_PIN |
|
|
#if (SUICIDE_PIN> -1) |
|
|
#if (SUICIDE_PIN > 0) |
|
|
SET_OUTPUT(SUICIDE_PIN); |
|
|
SET_OUTPUT(SUICIDE_PIN); |
|
|
WRITE(SUICIDE_PIN, LOW); |
|
|
WRITE(SUICIDE_PIN, LOW); |
|
|
#endif |
|
|
#endif |
|
@ -342,16 +342,16 @@ void suicide() |
|
|
|
|
|
|
|
|
void servo_init() |
|
|
void servo_init() |
|
|
{ |
|
|
{ |
|
|
#if (NUM_SERVOS >= 1) && defined (SERVO0_PIN) && (SERVO0_PIN > -1) |
|
|
#if (NUM_SERVOS >= 1) && (SERVO0_PIN > 0) |
|
|
servos[0].attach(SERVO0_PIN); |
|
|
servos[0].attach(SERVO0_PIN); |
|
|
#endif |
|
|
#endif |
|
|
#if (NUM_SERVOS >= 2) && defined (SERVO1_PIN) && (SERVO1_PIN > -1) |
|
|
#if (NUM_SERVOS >= 2) && (SERVO1_PIN > 0) |
|
|
servos[1].attach(SERVO1_PIN); |
|
|
servos[1].attach(SERVO1_PIN); |
|
|
#endif |
|
|
#endif |
|
|
#if (NUM_SERVOS >= 3) && defined (SERVO2_PIN) && (SERVO2_PIN > -1) |
|
|
#if (NUM_SERVOS >= 3) && (SERVO2_PIN > 0) |
|
|
servos[2].attach(SERVO2_PIN); |
|
|
servos[2].attach(SERVO2_PIN); |
|
|
#endif |
|
|
#endif |
|
|
#if (NUM_SERVOS >= 4) && defined (SERVO3_PIN) && (SERVO3_PIN > -1) |
|
|
#if (NUM_SERVOS >= 4) && (SERVO3_PIN > 0) |
|
|
servos[3].attach(SERVO3_PIN); |
|
|
servos[3].attach(SERVO3_PIN); |
|
|
#endif |
|
|
#endif |
|
|
#if (NUM_SERVOS >= 5) |
|
|
#if (NUM_SERVOS >= 5) |
|
@ -673,7 +673,7 @@ static void axis_is_at_home(int axis) { |
|
|
|
|
|
|
|
|
static void homeaxis(int axis) { |
|
|
static void homeaxis(int axis) { |
|
|
#define HOMEAXIS_DO(LETTER) \ |
|
|
#define HOMEAXIS_DO(LETTER) \ |
|
|
((LETTER##_MIN_PIN > -1 && LETTER##_HOME_DIR==-1) || (LETTER##_MAX_PIN > -1 && LETTER##_HOME_DIR==1)) |
|
|
((LETTER##_MIN_PIN > 0 && LETTER##_HOME_DIR==-1) || (LETTER##_MAX_PIN > 0 && LETTER##_HOME_DIR==1)) |
|
|
|
|
|
|
|
|
if (axis==X_AXIS ? HOMEAXIS_DO(X) : |
|
|
if (axis==X_AXIS ? HOMEAXIS_DO(X) : |
|
|
axis==Y_AXIS ? HOMEAXIS_DO(Y) : |
|
|
axis==Y_AXIS ? HOMEAXIS_DO(Y) : |
|
@ -911,13 +911,13 @@ void process_commands() |
|
|
previous_millis_cmd = millis(); |
|
|
previous_millis_cmd = millis(); |
|
|
if (codenum > 0){ |
|
|
if (codenum > 0){ |
|
|
codenum += millis(); // keep track of when we started waiting
|
|
|
codenum += millis(); // keep track of when we started waiting
|
|
|
while(millis() < codenum && !LCD_CLICKED){ |
|
|
while(millis() < codenum && !lcd_clicked()){ |
|
|
manage_heater(); |
|
|
manage_heater(); |
|
|
manage_inactivity(); |
|
|
manage_inactivity(); |
|
|
lcd_update(); |
|
|
lcd_update(); |
|
|
} |
|
|
} |
|
|
}else{ |
|
|
}else{ |
|
|
while(!LCD_CLICKED){ |
|
|
while(!lcd_clicked()){ |
|
|
manage_heater(); |
|
|
manage_heater(); |
|
|
manage_inactivity(); |
|
|
manage_inactivity(); |
|
|
lcd_update(); |
|
|
lcd_update(); |
|
@ -1062,12 +1062,12 @@ void process_commands() |
|
|
if(setTargetedHotend(105)){ |
|
|
if(setTargetedHotend(105)){ |
|
|
break; |
|
|
break; |
|
|
} |
|
|
} |
|
|
#if (TEMP_0_PIN > -1) |
|
|
#if (TEMP_0_PIN > 0) |
|
|
SERIAL_PROTOCOLPGM("ok T:"); |
|
|
SERIAL_PROTOCOLPGM("ok T:"); |
|
|
SERIAL_PROTOCOL_F(degHotend(tmp_extruder),1); |
|
|
SERIAL_PROTOCOL_F(degHotend(tmp_extruder),1); |
|
|
SERIAL_PROTOCOLPGM(" /"); |
|
|
SERIAL_PROTOCOLPGM(" /"); |
|
|
SERIAL_PROTOCOL_F(degTargetHotend(tmp_extruder),1); |
|
|
SERIAL_PROTOCOL_F(degTargetHotend(tmp_extruder),1); |
|
|
#if TEMP_BED_PIN > -1 |
|
|
#if TEMP_BED_PIN > 0 |
|
|
SERIAL_PROTOCOLPGM(" B:"); |
|
|
SERIAL_PROTOCOLPGM(" B:"); |
|
|
SERIAL_PROTOCOL_F(degBed(),1); |
|
|
SERIAL_PROTOCOL_F(degBed(),1); |
|
|
SERIAL_PROTOCOLPGM(" /"); |
|
|
SERIAL_PROTOCOLPGM(" /"); |
|
@ -1165,7 +1165,7 @@ void process_commands() |
|
|
} |
|
|
} |
|
|
break; |
|
|
break; |
|
|
case 190: // M190 - Wait for bed heater to reach target.
|
|
|
case 190: // M190 - Wait for bed heater to reach target.
|
|
|
#if TEMP_BED_PIN > -1 |
|
|
#if TEMP_BED_PIN > 0 |
|
|
LCD_MESSAGEPGM(MSG_BED_HEATING); |
|
|
LCD_MESSAGEPGM(MSG_BED_HEATING); |
|
|
if (code_seen('S')) setTargetBed(code_value()); |
|
|
if (code_seen('S')) setTargetBed(code_value()); |
|
|
codenum = millis(); |
|
|
codenum = millis(); |
|
@ -1192,7 +1192,7 @@ void process_commands() |
|
|
#endif |
|
|
#endif |
|
|
break; |
|
|
break; |
|
|
|
|
|
|
|
|
#if FAN_PIN > -1 |
|
|
#if FAN_PIN > 0 |
|
|
case 106: //M106 Fan On
|
|
|
case 106: //M106 Fan On
|
|
|
if (code_seen('S')){ |
|
|
if (code_seen('S')){ |
|
|
fanSpeed=constrain(code_value(),0,255); |
|
|
fanSpeed=constrain(code_value(),0,255); |
|
@ -1207,7 +1207,7 @@ void process_commands() |
|
|
#endif //FAN_PIN
|
|
|
#endif //FAN_PIN
|
|
|
#ifdef BARICUDA |
|
|
#ifdef BARICUDA |
|
|
// PWM for HEATER_1_PIN
|
|
|
// PWM for HEATER_1_PIN
|
|
|
#if HEATER_1_PIN > -1 |
|
|
#if HEATER_1_PIN > 0 |
|
|
case 126: //M126 valve open
|
|
|
case 126: //M126 valve open
|
|
|
if (code_seen('S')){ |
|
|
if (code_seen('S')){ |
|
|
ValvePressure=constrain(code_value(),0,255); |
|
|
ValvePressure=constrain(code_value(),0,255); |
|
@ -1222,7 +1222,7 @@ void process_commands() |
|
|
#endif //HEATER_1_PIN
|
|
|
#endif //HEATER_1_PIN
|
|
|
|
|
|
|
|
|
// PWM for HEATER_2_PIN
|
|
|
// PWM for HEATER_2_PIN
|
|
|
#if HEATER_2_PIN > -1 |
|
|
#if HEATER_2_PIN > 0 |
|
|
case 128: //M128 valve open
|
|
|
case 128: //M128 valve open
|
|
|
if (code_seen('S')){ |
|
|
if (code_seen('S')){ |
|
|
EtoPPressure=constrain(code_value(),0,255); |
|
|
EtoPPressure=constrain(code_value(),0,255); |
|
@ -1237,7 +1237,7 @@ void process_commands() |
|
|
#endif //HEATER_2_PIN
|
|
|
#endif //HEATER_2_PIN
|
|
|
#endif |
|
|
#endif |
|
|
|
|
|
|
|
|
#if (PS_ON_PIN > -1) |
|
|
#if (PS_ON_PIN > 0) |
|
|
case 80: // M80 - ATX Power On
|
|
|
case 80: // M80 - ATX Power On
|
|
|
SET_OUTPUT(PS_ON_PIN); //GND
|
|
|
SET_OUTPUT(PS_ON_PIN); //GND
|
|
|
WRITE(PS_ON_PIN, PS_ON_AWAKE); |
|
|
WRITE(PS_ON_PIN, PS_ON_AWAKE); |
|
@ -1246,10 +1246,10 @@ void process_commands() |
|
|
|
|
|
|
|
|
case 81: // M81 - ATX Power Off
|
|
|
case 81: // M81 - ATX Power Off
|
|
|
|
|
|
|
|
|
#if defined SUICIDE_PIN && SUICIDE_PIN > -1 |
|
|
#if defined SUICIDE_PIN && SUICIDE_PIN > 0 |
|
|
st_synchronize(); |
|
|
st_synchronize(); |
|
|
suicide(); |
|
|
suicide(); |
|
|
#elif (PS_ON_PIN > -1) |
|
|
#elif (PS_ON_PIN > 0) |
|
|
SET_OUTPUT(PS_ON_PIN); |
|
|
SET_OUTPUT(PS_ON_PIN); |
|
|
WRITE(PS_ON_PIN, PS_ON_ASLEEP); |
|
|
WRITE(PS_ON_PIN, PS_ON_ASLEEP); |
|
|
#endif |
|
|
#endif |
|
@ -1354,27 +1354,27 @@ void process_commands() |
|
|
break; |
|
|
break; |
|
|
case 119: // M119
|
|
|
case 119: // M119
|
|
|
SERIAL_PROTOCOLLN(MSG_M119_REPORT); |
|
|
SERIAL_PROTOCOLLN(MSG_M119_REPORT); |
|
|
#if (X_MIN_PIN > -1) |
|
|
#if (X_MIN_PIN > 0) |
|
|
SERIAL_PROTOCOLPGM(MSG_X_MIN); |
|
|
SERIAL_PROTOCOLPGM(MSG_X_MIN); |
|
|
SERIAL_PROTOCOLLN(((READ(X_MIN_PIN)^X_ENDSTOPS_INVERTING)?MSG_ENDSTOP_HIT:MSG_ENDSTOP_OPEN)); |
|
|
SERIAL_PROTOCOLLN(((READ(X_MIN_PIN)^X_ENDSTOPS_INVERTING)?MSG_ENDSTOP_HIT:MSG_ENDSTOP_OPEN)); |
|
|
#endif |
|
|
#endif |
|
|
#if (X_MAX_PIN > -1) |
|
|
#if (X_MAX_PIN > 0) |
|
|
SERIAL_PROTOCOLPGM(MSG_X_MAX); |
|
|
SERIAL_PROTOCOLPGM(MSG_X_MAX); |
|
|
SERIAL_PROTOCOLLN(((READ(X_MAX_PIN)^X_ENDSTOPS_INVERTING)?MSG_ENDSTOP_HIT:MSG_ENDSTOP_OPEN)); |
|
|
SERIAL_PROTOCOLLN(((READ(X_MAX_PIN)^X_ENDSTOPS_INVERTING)?MSG_ENDSTOP_HIT:MSG_ENDSTOP_OPEN)); |
|
|
#endif |
|
|
#endif |
|
|
#if (Y_MIN_PIN > -1) |
|
|
#if (Y_MIN_PIN > 0) |
|
|
SERIAL_PROTOCOLPGM(MSG_Y_MIN); |
|
|
SERIAL_PROTOCOLPGM(MSG_Y_MIN); |
|
|
SERIAL_PROTOCOLLN(((READ(Y_MIN_PIN)^Y_ENDSTOPS_INVERTING)?MSG_ENDSTOP_HIT:MSG_ENDSTOP_OPEN)); |
|
|
SERIAL_PROTOCOLLN(((READ(Y_MIN_PIN)^Y_ENDSTOPS_INVERTING)?MSG_ENDSTOP_HIT:MSG_ENDSTOP_OPEN)); |
|
|
#endif |
|
|
#endif |
|
|
#if (Y_MAX_PIN > -1) |
|
|
#if (Y_MAX_PIN > 0) |
|
|
SERIAL_PROTOCOLPGM(MSG_Y_MAX); |
|
|
SERIAL_PROTOCOLPGM(MSG_Y_MAX); |
|
|
SERIAL_PROTOCOLLN(((READ(Y_MAX_PIN)^Y_ENDSTOPS_INVERTING)?MSG_ENDSTOP_HIT:MSG_ENDSTOP_OPEN)); |
|
|
SERIAL_PROTOCOLLN(((READ(Y_MAX_PIN)^Y_ENDSTOPS_INVERTING)?MSG_ENDSTOP_HIT:MSG_ENDSTOP_OPEN)); |
|
|
#endif |
|
|
#endif |
|
|
#if (Z_MIN_PIN > -1) |
|
|
#if (Z_MIN_PIN > 0) |
|
|
SERIAL_PROTOCOLPGM(MSG_Z_MIN); |
|
|
SERIAL_PROTOCOLPGM(MSG_Z_MIN); |
|
|
SERIAL_PROTOCOLLN(((READ(Z_MIN_PIN)^Z_ENDSTOPS_INVERTING)?MSG_ENDSTOP_HIT:MSG_ENDSTOP_OPEN)); |
|
|
SERIAL_PROTOCOLLN(((READ(Z_MIN_PIN)^Z_ENDSTOPS_INVERTING)?MSG_ENDSTOP_HIT:MSG_ENDSTOP_OPEN)); |
|
|
#endif |
|
|
#endif |
|
|
#if (Z_MAX_PIN > -1) |
|
|
#if (Z_MAX_PIN > 0) |
|
|
SERIAL_PROTOCOLPGM(MSG_Z_MAX); |
|
|
SERIAL_PROTOCOLPGM(MSG_Z_MAX); |
|
|
SERIAL_PROTOCOLLN(((READ(Z_MAX_PIN)^Z_ENDSTOPS_INVERTING)?MSG_ENDSTOP_HIT:MSG_ENDSTOP_OPEN)); |
|
|
SERIAL_PROTOCOLLN(((READ(Z_MAX_PIN)^Z_ENDSTOPS_INVERTING)?MSG_ENDSTOP_HIT:MSG_ENDSTOP_OPEN)); |
|
|
#endif |
|
|
#endif |
|
@ -1514,7 +1514,7 @@ void process_commands() |
|
|
} |
|
|
} |
|
|
break; |
|
|
break; |
|
|
|
|
|
|
|
|
#if (defined NUM_SERVOS) && (NUM_SERVOS > 0) |
|
|
#if NUM_SERVOS > 0 |
|
|
case 280: // M280 - set servo position absolute. P: servo index, S: angle or microseconds
|
|
|
case 280: // M280 - set servo position absolute. P: servo index, S: angle or microseconds
|
|
|
{ |
|
|
{ |
|
|
int servo_index = -1; |
|
|
int servo_index = -1; |
|
@ -1545,16 +1545,20 @@ void process_commands() |
|
|
break; |
|
|
break; |
|
|
#endif // NUM_SERVOS > 0
|
|
|
#endif // NUM_SERVOS > 0
|
|
|
|
|
|
|
|
|
#if defined(LARGE_FLASH) && LARGE_FLASH == true && defined(BEEPER) && BEEPER > -1 |
|
|
#if LARGE_FLASH == true && ( BEEPER > 0 || defined(ULTRALCD) ) |
|
|
case 300: // M300
|
|
|
case 300: // M300
|
|
|
{ |
|
|
{ |
|
|
int beepS = 1; |
|
|
int beepS = 400; |
|
|
int beepP = 1000; |
|
|
int beepP = 1000; |
|
|
if(code_seen('S')) beepS = code_value(); |
|
|
if(code_seen('S')) beepS = code_value(); |
|
|
if(code_seen('P')) beepP = code_value(); |
|
|
if(code_seen('P')) beepP = code_value(); |
|
|
|
|
|
#if BEEPER > 0 |
|
|
tone(BEEPER, beepS); |
|
|
tone(BEEPER, beepS); |
|
|
delay(beepP); |
|
|
delay(beepP); |
|
|
noTone(BEEPER); |
|
|
noTone(BEEPER); |
|
|
|
|
|
#elif defined(ULTRALCD) |
|
|
|
|
|
lcd_buzz(beepS, beepP); |
|
|
|
|
|
#endif |
|
|
} |
|
|
} |
|
|
break; |
|
|
break; |
|
|
#endif // M300
|
|
|
#endif // M300
|
|
@ -1609,7 +1613,7 @@ void process_commands() |
|
|
case 240: // M240 Triggers a camera by emulating a Canon RC-1 : http://www.doc-diy.net/photo/rc-1_hacked/
|
|
|
case 240: // M240 Triggers a camera by emulating a Canon RC-1 : http://www.doc-diy.net/photo/rc-1_hacked/
|
|
|
{ |
|
|
{ |
|
|
#ifdef PHOTOGRAPH_PIN |
|
|
#ifdef PHOTOGRAPH_PIN |
|
|
#if (PHOTOGRAPH_PIN > -1) |
|
|
#if (PHOTOGRAPH_PIN > 0) |
|
|
const uint8_t NUM_PULSES=16; |
|
|
const uint8_t NUM_PULSES=16; |
|
|
const float PULSE_LENGTH=0.01524; |
|
|
const float PULSE_LENGTH=0.01524; |
|
|
for(int i=0; i < NUM_PULSES; i++) { |
|
|
for(int i=0; i < NUM_PULSES; i++) { |
|
@ -1765,24 +1769,25 @@ void process_commands() |
|
|
delay(100); |
|
|
delay(100); |
|
|
LCD_ALERTMESSAGEPGM(MSG_FILAMENTCHANGE); |
|
|
LCD_ALERTMESSAGEPGM(MSG_FILAMENTCHANGE); |
|
|
uint8_t cnt=0; |
|
|
uint8_t cnt=0; |
|
|
while(!LCD_CLICKED){ |
|
|
while(!lcd_clicked()){ |
|
|
cnt++; |
|
|
cnt++; |
|
|
manage_heater(); |
|
|
manage_heater(); |
|
|
manage_inactivity(); |
|
|
manage_inactivity(); |
|
|
lcd_update(); |
|
|
lcd_update(); |
|
|
|
|
|
|
|
|
#if BEEPER > -1 |
|
|
|
|
|
if(cnt==0) |
|
|
if(cnt==0) |
|
|
{ |
|
|
{ |
|
|
|
|
|
#if BEEPER > 0 |
|
|
SET_OUTPUT(BEEPER); |
|
|
SET_OUTPUT(BEEPER); |
|
|
|
|
|
|
|
|
WRITE(BEEPER,HIGH); |
|
|
WRITE(BEEPER,HIGH); |
|
|
delay(3); |
|
|
delay(3); |
|
|
WRITE(BEEPER,LOW); |
|
|
WRITE(BEEPER,LOW); |
|
|
delay(3); |
|
|
delay(3); |
|
|
} |
|
|
#else |
|
|
|
|
|
lcd_buzz(1000/6,100); |
|
|
#endif |
|
|
#endif |
|
|
} |
|
|
} |
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
//return to normal
|
|
|
//return to normal
|
|
|
if(code_seen('L')) |
|
|
if(code_seen('L')) |
|
@ -1806,7 +1811,7 @@ void process_commands() |
|
|
#endif //FILAMENTCHANGEENABLE
|
|
|
#endif //FILAMENTCHANGEENABLE
|
|
|
case 907: // M907 Set digital trimpot motor current using axis codes.
|
|
|
case 907: // M907 Set digital trimpot motor current using axis codes.
|
|
|
{ |
|
|
{ |
|
|
#if DIGIPOTSS_PIN > -1 |
|
|
#if DIGIPOTSS_PIN > 0 |
|
|
for(int i=0;i<NUM_AXIS;i++) if(code_seen(axis_codes[i])) digipot_current(i,code_value()); |
|
|
for(int i=0;i<NUM_AXIS;i++) if(code_seen(axis_codes[i])) digipot_current(i,code_value()); |
|
|
if(code_seen('B')) digipot_current(4,code_value()); |
|
|
if(code_seen('B')) digipot_current(4,code_value()); |
|
|
if(code_seen('S')) for(int i=0;i<=4;i++) digipot_current(i,code_value()); |
|
|
if(code_seen('S')) for(int i=0;i<=4;i++) digipot_current(i,code_value()); |
|
@ -1815,7 +1820,7 @@ void process_commands() |
|
|
break; |
|
|
break; |
|
|
case 908: // M908 Control digital trimpot directly.
|
|
|
case 908: // M908 Control digital trimpot directly.
|
|
|
{ |
|
|
{ |
|
|
#if DIGIPOTSS_PIN > -1 |
|
|
#if DIGIPOTSS_PIN > 0 |
|
|
uint8_t channel,current; |
|
|
uint8_t channel,current; |
|
|
if(code_seen('P')) channel=code_value(); |
|
|
if(code_seen('P')) channel=code_value(); |
|
|
if(code_seen('S')) current=code_value(); |
|
|
if(code_seen('S')) current=code_value(); |
|
@ -1825,7 +1830,7 @@ void process_commands() |
|
|
break; |
|
|
break; |
|
|
case 350: // M350 Set microstepping mode. Warning: Steps per unit remains unchanged. S code sets stepping mode for all drivers.
|
|
|
case 350: // M350 Set microstepping mode. Warning: Steps per unit remains unchanged. S code sets stepping mode for all drivers.
|
|
|
{ |
|
|
{ |
|
|
#if X_MS1_PIN > -1 |
|
|
#if X_MS1_PIN > 0 |
|
|
if(code_seen('S')) for(int i=0;i<=4;i++) microstep_mode(i,code_value()); |
|
|
if(code_seen('S')) for(int i=0;i<=4;i++) microstep_mode(i,code_value()); |
|
|
for(int i=0;i<NUM_AXIS;i++) if(code_seen(axis_codes[i])) microstep_mode(i,(uint8_t)code_value()); |
|
|
for(int i=0;i<NUM_AXIS;i++) if(code_seen(axis_codes[i])) microstep_mode(i,(uint8_t)code_value()); |
|
|
if(code_seen('B')) microstep_mode(4,code_value()); |
|
|
if(code_seen('B')) microstep_mode(4,code_value()); |
|
@ -1835,7 +1840,7 @@ void process_commands() |
|
|
break; |
|
|
break; |
|
|
case 351: // M351 Toggle MS1 MS2 pins directly, S# determines MS1 or MS2, X# sets the pin high/low.
|
|
|
case 351: // M351 Toggle MS1 MS2 pins directly, S# determines MS1 or MS2, X# sets the pin high/low.
|
|
|
{ |
|
|
{ |
|
|
#if X_MS1_PIN > -1 |
|
|
#if X_MS1_PIN > 0 |
|
|
if(code_seen('S')) switch((int)code_value()) |
|
|
if(code_seen('S')) switch((int)code_value()) |
|
|
{ |
|
|
{ |
|
|
case 1: |
|
|
case 1: |
|
@ -2173,7 +2178,7 @@ void kill() |
|
|
disable_e1(); |
|
|
disable_e1(); |
|
|
disable_e2(); |
|
|
disable_e2(); |
|
|
|
|
|
|
|
|
if(PS_ON_PIN > -1) pinMode(PS_ON_PIN,INPUT); |
|
|
if(PS_ON_PIN > 0) pinMode(PS_ON_PIN,INPUT); |
|
|
SERIAL_ERROR_START; |
|
|
SERIAL_ERROR_START; |
|
|
SERIAL_ERRORLNPGM(MSG_ERR_KILLED); |
|
|
SERIAL_ERRORLNPGM(MSG_ERR_KILLED); |
|
|
LCD_ALERTMESSAGEPGM(MSG_KILLED); |
|
|
LCD_ALERTMESSAGEPGM(MSG_KILLED); |
|
|