|
|
|
@ -44,7 +44,7 @@ |
|
|
|
#include "Servo.h" |
|
|
|
#endif |
|
|
|
|
|
|
|
#if DIGIPOTSS_PIN > 0 |
|
|
|
#if defined(DIGIPOTSS_PIN) && DIGIPOTSS_PIN > -1 |
|
|
|
#include <SPI.h> |
|
|
|
#endif |
|
|
|
|
|
|
|
@ -300,7 +300,7 @@ void enquecommand_P(const char *cmd) |
|
|
|
|
|
|
|
void setup_killpin() |
|
|
|
{ |
|
|
|
#if( KILL_PIN>-1 ) |
|
|
|
#if defined(KILL_PIN) && KILL_PIN > -1 |
|
|
|
pinMode(KILL_PIN,INPUT); |
|
|
|
WRITE(KILL_PIN,HIGH); |
|
|
|
#endif |
|
|
|
@ -308,50 +308,44 @@ void setup_killpin() |
|
|
|
|
|
|
|
void setup_photpin() |
|
|
|
{ |
|
|
|
#ifdef PHOTOGRAPH_PIN |
|
|
|
#if (PHOTOGRAPH_PIN > 0) |
|
|
|
#if defined(PHOTOGRAPH_PIN) && PHOTOGRAPH_PIN > -1 |
|
|
|
SET_OUTPUT(PHOTOGRAPH_PIN); |
|
|
|
WRITE(PHOTOGRAPH_PIN, LOW); |
|
|
|
#endif |
|
|
|
#endif |
|
|
|
} |
|
|
|
|
|
|
|
void setup_powerhold() |
|
|
|
{ |
|
|
|
#ifdef SUICIDE_PIN |
|
|
|
#if (SUICIDE_PIN> 0) |
|
|
|
SET_OUTPUT(SUICIDE_PIN); |
|
|
|
WRITE(SUICIDE_PIN, HIGH); |
|
|
|
#endif |
|
|
|
#endif |
|
|
|
#if (PS_ON_PIN > 0) |
|
|
|
SET_OUTPUT(PS_ON_PIN); |
|
|
|
WRITE(PS_ON_PIN, PS_ON_AWAKE); |
|
|
|
#endif |
|
|
|
#if defined(SUICIDE_PIN) && SUICIDE_PIN > -1 |
|
|
|
SET_OUTPUT(SUICIDE_PIN); |
|
|
|
WRITE(SUICIDE_PIN, HIGH); |
|
|
|
#endif |
|
|
|
#if defined(PS_ON_PIN) && PS_ON_PIN > -1 |
|
|
|
SET_OUTPUT(PS_ON_PIN); |
|
|
|
WRITE(PS_ON_PIN, PS_ON_AWAKE); |
|
|
|
#endif |
|
|
|
} |
|
|
|
|
|
|
|
void suicide() |
|
|
|
{ |
|
|
|
#ifdef SUICIDE_PIN |
|
|
|
#if (SUICIDE_PIN > 0) |
|
|
|
SET_OUTPUT(SUICIDE_PIN); |
|
|
|
WRITE(SUICIDE_PIN, LOW); |
|
|
|
#endif |
|
|
|
#if defined(SUICIDE_PIN) && SUICIDE_PIN > -1 |
|
|
|
SET_OUTPUT(SUICIDE_PIN); |
|
|
|
WRITE(SUICIDE_PIN, LOW); |
|
|
|
#endif |
|
|
|
} |
|
|
|
|
|
|
|
void servo_init() |
|
|
|
{ |
|
|
|
#if (NUM_SERVOS >= 1) && (SERVO0_PIN > 0) |
|
|
|
#if (NUM_SERVOS >= 1) && defined(SERVO0_PIN) && (SERVO0_PIN > -1) |
|
|
|
servos[0].attach(SERVO0_PIN); |
|
|
|
#endif |
|
|
|
#if (NUM_SERVOS >= 2) && (SERVO1_PIN > 0) |
|
|
|
#if (NUM_SERVOS >= 2) && defined(SERVO1_PIN) && (SERVO1_PIN > -1) |
|
|
|
servos[1].attach(SERVO1_PIN); |
|
|
|
#endif |
|
|
|
#if (NUM_SERVOS >= 3) && (SERVO2_PIN > 0) |
|
|
|
#if (NUM_SERVOS >= 3) && defined(SERVO2_PIN) && (SERVO2_PIN > -1) |
|
|
|
servos[2].attach(SERVO2_PIN); |
|
|
|
#endif |
|
|
|
#if (NUM_SERVOS >= 4) && (SERVO3_PIN > 0) |
|
|
|
#if (NUM_SERVOS >= 4) && defined(SERVO3_PIN) && (SERVO3_PIN > -1) |
|
|
|
servos[3].attach(SERVO3_PIN); |
|
|
|
#endif |
|
|
|
#if (NUM_SERVOS >= 5) |
|
|
|
@ -411,7 +405,7 @@ void setup() |
|
|
|
|
|
|
|
lcd_init(); |
|
|
|
|
|
|
|
#if CONTROLLERFAN_PIN > 0 |
|
|
|
#if defined(CONTROLLERFAN_PIN) && CONTROLLERFAN_PIN > -1 |
|
|
|
SET_OUTPUT(CONTROLLERFAN_PIN); //Set pin used for driver cooling fan
|
|
|
|
#endif |
|
|
|
} |
|
|
|
@ -669,7 +663,7 @@ static void axis_is_at_home(int axis) { |
|
|
|
|
|
|
|
static void homeaxis(int axis) { |
|
|
|
#define HOMEAXIS_DO(LETTER) \ |
|
|
|
((LETTER##_MIN_PIN > 0 && LETTER##_HOME_DIR==-1) || (LETTER##_MAX_PIN > 0 && LETTER##_HOME_DIR==1)) |
|
|
|
((LETTER##_MIN_PIN > -1 && LETTER##_HOME_DIR==-1) || (LETTER##_MAX_PIN > -1 && LETTER##_HOME_DIR==1)) |
|
|
|
|
|
|
|
if (axis==X_AXIS ? HOMEAXIS_DO(X) : |
|
|
|
axis==Y_AXIS ? HOMEAXIS_DO(Y) : |
|
|
|
@ -1036,7 +1030,7 @@ void process_commands() |
|
|
|
break; |
|
|
|
} |
|
|
|
} |
|
|
|
#if FAN_PIN > 0 |
|
|
|
#if defined(FAN_PIN) && FAN_PIN > -1 |
|
|
|
if (pin_number == FAN_PIN) |
|
|
|
fanSpeed = pin_status; |
|
|
|
#endif |
|
|
|
@ -1062,12 +1056,12 @@ void process_commands() |
|
|
|
if(setTargetedHotend(105)){ |
|
|
|
break; |
|
|
|
} |
|
|
|
#if (TEMP_0_PIN > 0) |
|
|
|
#if defined(TEMP_0_PIN) && TEMP_0_PIN > -1 |
|
|
|
SERIAL_PROTOCOLPGM("ok T:"); |
|
|
|
SERIAL_PROTOCOL_F(degHotend(tmp_extruder),1); |
|
|
|
SERIAL_PROTOCOLPGM(" /"); |
|
|
|
SERIAL_PROTOCOL_F(degTargetHotend(tmp_extruder),1); |
|
|
|
#if TEMP_BED_PIN > 0 |
|
|
|
#if defined(TEMP_BED_PIN) && TEMP_BED_PIN > -1 |
|
|
|
SERIAL_PROTOCOLPGM(" B:"); |
|
|
|
SERIAL_PROTOCOL_F(degBed(),1); |
|
|
|
SERIAL_PROTOCOLPGM(" /"); |
|
|
|
@ -1165,7 +1159,7 @@ void process_commands() |
|
|
|
} |
|
|
|
break; |
|
|
|
case 190: // M190 - Wait for bed heater to reach target.
|
|
|
|
#if TEMP_BED_PIN > 0 |
|
|
|
#if defined(TEMP_BED_PIN) && TEMP_BED_PIN > -1 |
|
|
|
LCD_MESSAGEPGM(MSG_BED_HEATING); |
|
|
|
if (code_seen('S')) setTargetBed(code_value()); |
|
|
|
codenum = millis(); |
|
|
|
@ -1192,7 +1186,7 @@ void process_commands() |
|
|
|
#endif |
|
|
|
break; |
|
|
|
|
|
|
|
#if FAN_PIN > 0 |
|
|
|
#if defined(FAN_PIN) && FAN_PIN > -1 |
|
|
|
case 106: //M106 Fan On
|
|
|
|
if (code_seen('S')){ |
|
|
|
fanSpeed=constrain(code_value(),0,255); |
|
|
|
@ -1207,7 +1201,7 @@ void process_commands() |
|
|
|
#endif //FAN_PIN
|
|
|
|
#ifdef BARICUDA |
|
|
|
// PWM for HEATER_1_PIN
|
|
|
|
#if HEATER_1_PIN > 0 |
|
|
|
#if defined(HEATER_1_PIN) && HEATER_1_PIN > -1 |
|
|
|
case 126: //M126 valve open
|
|
|
|
if (code_seen('S')){ |
|
|
|
ValvePressure=constrain(code_value(),0,255); |
|
|
|
@ -1222,7 +1216,7 @@ void process_commands() |
|
|
|
#endif //HEATER_1_PIN
|
|
|
|
|
|
|
|
// PWM for HEATER_2_PIN
|
|
|
|
#if HEATER_2_PIN > 0 |
|
|
|
#if defined(HEATER_2_PIN) && HEATER_2_PIN > -1 |
|
|
|
case 128: //M128 valve open
|
|
|
|
if (code_seen('S')){ |
|
|
|
EtoPPressure=constrain(code_value(),0,255); |
|
|
|
@ -1237,7 +1231,7 @@ void process_commands() |
|
|
|
#endif //HEATER_2_PIN
|
|
|
|
#endif |
|
|
|
|
|
|
|
#if (PS_ON_PIN > 0) |
|
|
|
#if defined(PS_ON_PIN) && PS_ON_PIN > -1 |
|
|
|
case 80: // M80 - ATX Power On
|
|
|
|
SET_OUTPUT(PS_ON_PIN); //GND
|
|
|
|
WRITE(PS_ON_PIN, PS_ON_AWAKE); |
|
|
|
@ -1246,10 +1240,10 @@ void process_commands() |
|
|
|
|
|
|
|
case 81: // M81 - ATX Power Off
|
|
|
|
|
|
|
|
#if defined SUICIDE_PIN && SUICIDE_PIN > 0 |
|
|
|
#if defined(SUICIDE_PIN) && SUICIDE_PIN > -1 |
|
|
|
st_synchronize(); |
|
|
|
suicide(); |
|
|
|
#elif (PS_ON_PIN > 0) |
|
|
|
#elif defined(PS_ON_PIN) && PS_ON_PIN > -1 |
|
|
|
SET_OUTPUT(PS_ON_PIN); |
|
|
|
WRITE(PS_ON_PIN, PS_ON_ASLEEP); |
|
|
|
#endif |
|
|
|
@ -1354,27 +1348,27 @@ void process_commands() |
|
|
|
break; |
|
|
|
case 119: // M119
|
|
|
|
SERIAL_PROTOCOLLN(MSG_M119_REPORT); |
|
|
|
#if (X_MIN_PIN > 0) |
|
|
|
#if defined(X_MIN_PIN) && X_MIN_PIN > -1 |
|
|
|
SERIAL_PROTOCOLPGM(MSG_X_MIN); |
|
|
|
SERIAL_PROTOCOLLN(((READ(X_MIN_PIN)^X_ENDSTOPS_INVERTING)?MSG_ENDSTOP_HIT:MSG_ENDSTOP_OPEN)); |
|
|
|
#endif |
|
|
|
#if (X_MAX_PIN > 0) |
|
|
|
#if defined(X_MAX_PIN) && X_MAX_PIN > -1 |
|
|
|
SERIAL_PROTOCOLPGM(MSG_X_MAX); |
|
|
|
SERIAL_PROTOCOLLN(((READ(X_MAX_PIN)^X_ENDSTOPS_INVERTING)?MSG_ENDSTOP_HIT:MSG_ENDSTOP_OPEN)); |
|
|
|
#endif |
|
|
|
#if (Y_MIN_PIN > 0) |
|
|
|
#if defined(Y_MIN_PIN) && Y_MIN_PIN > -1 |
|
|
|
SERIAL_PROTOCOLPGM(MSG_Y_MIN); |
|
|
|
SERIAL_PROTOCOLLN(((READ(Y_MIN_PIN)^Y_ENDSTOPS_INVERTING)?MSG_ENDSTOP_HIT:MSG_ENDSTOP_OPEN)); |
|
|
|
#endif |
|
|
|
#if (Y_MAX_PIN > 0) |
|
|
|
#if defined(Y_MAX_PIN) && Y_MAX_PIN > -1 |
|
|
|
SERIAL_PROTOCOLPGM(MSG_Y_MAX); |
|
|
|
SERIAL_PROTOCOLLN(((READ(Y_MAX_PIN)^Y_ENDSTOPS_INVERTING)?MSG_ENDSTOP_HIT:MSG_ENDSTOP_OPEN)); |
|
|
|
#endif |
|
|
|
#if (Z_MIN_PIN > 0) |
|
|
|
#if defined(Z_MIN_PIN) && Z_MIN_PIN > -1 |
|
|
|
SERIAL_PROTOCOLPGM(MSG_Z_MIN); |
|
|
|
SERIAL_PROTOCOLLN(((READ(Z_MIN_PIN)^Z_ENDSTOPS_INVERTING)?MSG_ENDSTOP_HIT:MSG_ENDSTOP_OPEN)); |
|
|
|
#endif |
|
|
|
#if (Z_MAX_PIN > 0) |
|
|
|
#if defined(Z_MAX_PIN) && Z_MAX_PIN > -1 |
|
|
|
SERIAL_PROTOCOLPGM(MSG_Z_MAX); |
|
|
|
SERIAL_PROTOCOLLN(((READ(Z_MAX_PIN)^Z_ENDSTOPS_INVERTING)?MSG_ENDSTOP_HIT:MSG_ENDSTOP_OPEN)); |
|
|
|
#endif |
|
|
|
@ -1612,8 +1606,7 @@ void process_commands() |
|
|
|
#endif //PIDTEMP
|
|
|
|
case 240: // M240 Triggers a camera by emulating a Canon RC-1 : http://www.doc-diy.net/photo/rc-1_hacked/
|
|
|
|
{ |
|
|
|
#ifdef PHOTOGRAPH_PIN |
|
|
|
#if (PHOTOGRAPH_PIN > 0) |
|
|
|
#if defined(PHOTOGRAPH_PIN) && PHOTOGRAPH_PIN > -1 |
|
|
|
const uint8_t NUM_PULSES=16; |
|
|
|
const float PULSE_LENGTH=0.01524; |
|
|
|
for(int i=0; i < NUM_PULSES; i++) { |
|
|
|
@ -1629,7 +1622,6 @@ void process_commands() |
|
|
|
WRITE(PHOTOGRAPH_PIN, LOW); |
|
|
|
_delay_ms(PULSE_LENGTH); |
|
|
|
} |
|
|
|
#endif |
|
|
|
#endif |
|
|
|
} |
|
|
|
break; |
|
|
|
@ -1811,7 +1803,7 @@ void process_commands() |
|
|
|
#endif //FILAMENTCHANGEENABLE
|
|
|
|
case 907: // M907 Set digital trimpot motor current using axis codes.
|
|
|
|
{ |
|
|
|
#if DIGIPOTSS_PIN > 0 |
|
|
|
#if defined(DIGIPOTSS_PIN) && DIGIPOTSS_PIN > -1 |
|
|
|
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('S')) for(int i=0;i<=4;i++) digipot_current(i,code_value()); |
|
|
|
@ -1820,7 +1812,7 @@ void process_commands() |
|
|
|
break; |
|
|
|
case 908: // M908 Control digital trimpot directly.
|
|
|
|
{ |
|
|
|
#if DIGIPOTSS_PIN > 0 |
|
|
|
#if defined(DIGIPOTSS_PIN) && DIGIPOTSS_PIN > -1 |
|
|
|
uint8_t channel,current; |
|
|
|
if(code_seen('P')) channel=code_value(); |
|
|
|
if(code_seen('S')) current=code_value(); |
|
|
|
@ -1830,7 +1822,7 @@ void process_commands() |
|
|
|
break; |
|
|
|
case 350: // M350 Set microstepping mode. Warning: Steps per unit remains unchanged. S code sets stepping mode for all drivers.
|
|
|
|
{ |
|
|
|
#if X_MS1_PIN > 0 |
|
|
|
#if defined(X_MS1_PIN) && X_MS1_PIN > -1 |
|
|
|
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()); |
|
|
|
if(code_seen('B')) microstep_mode(4,code_value()); |
|
|
|
@ -1840,7 +1832,7 @@ void process_commands() |
|
|
|
break; |
|
|
|
case 351: // M351 Toggle MS1 MS2 pins directly, S# determines MS1 or MS2, X# sets the pin high/low.
|
|
|
|
{ |
|
|
|
#if X_MS1_PIN > 0 |
|
|
|
#if defined(X_MS1_PIN) && X_MS1_PIN > -1 |
|
|
|
if(code_seen('S')) switch((int)code_value()) |
|
|
|
{ |
|
|
|
case 1: |
|
|
|
@ -2064,11 +2056,13 @@ void prepare_arc_move(char isclockwise) { |
|
|
|
previous_millis_cmd = millis(); |
|
|
|
} |
|
|
|
|
|
|
|
#if CONTROLLERFAN_PIN > 0 |
|
|
|
#if defined(CONTROLLERFAN_PIN) && CONTROLLERFAN_PIN > -1 |
|
|
|
|
|
|
|
#if CONTROLLERFAN_PIN == FAN_PIN |
|
|
|
#error "You cannot set CONTROLLERFAN_PIN equal to FAN_PIN" |
|
|
|
#endif |
|
|
|
#if defined(FAN_PIN) |
|
|
|
#if CONTROLLERFAN_PIN == FAN_PIN |
|
|
|
#error "You cannot set CONTROLLERFAN_PIN equal to FAN_PIN" |
|
|
|
#endif |
|
|
|
#endif |
|
|
|
|
|
|
|
unsigned long lastMotor = 0; //Save the time for when a motor was turned on last
|
|
|
|
unsigned long lastMotorCheck = 0; |
|
|
|
@ -2124,11 +2118,11 @@ void manage_inactivity() |
|
|
|
} |
|
|
|
} |
|
|
|
} |
|
|
|
#if KILL_PIN > 0 |
|
|
|
#if defined(KILL_PIN) && KILL_PIN > -1 |
|
|
|
if( 0 == READ(KILL_PIN) ) |
|
|
|
kill(); |
|
|
|
#endif |
|
|
|
#if CONTROLLERFAN_PIN > 0 |
|
|
|
#if defined(CONTROLLERFAN_PIN) && CONTROLLERFAN_PIN > -1 |
|
|
|
controllerFan(); //Check if fan should be turned on to cool stepper drivers down
|
|
|
|
#endif |
|
|
|
#ifdef EXTRUDER_RUNOUT_PREVENT |
|
|
|
@ -2165,7 +2159,9 @@ void kill() |
|
|
|
disable_e1(); |
|
|
|
disable_e2(); |
|
|
|
|
|
|
|
if(PS_ON_PIN > 0) pinMode(PS_ON_PIN,INPUT); |
|
|
|
#if defined(PS_ON_PIN) && PS_ON_PIN > -1 |
|
|
|
pinMode(PS_ON_PIN,INPUT); |
|
|
|
#endif |
|
|
|
SERIAL_ERROR_START; |
|
|
|
SERIAL_ERRORLNPGM(MSG_ERR_KILLED); |
|
|
|
LCD_ALERTMESSAGEPGM(MSG_KILLED); |
|
|
|
|
ErikZalm
12 years ago