Skip to content
Snippets Groups Projects

Matlab stepper fix

Merged Kyrre Ness Sjobaek requested to merge MatlabStepperFix into master
2 files
+ 55
10
Compare changes
  • Side-by-side
  • Inline
Files
2
@@ -67,7 +67,12 @@ void stepper_control() {
if(onLimitCount_away > stepper_onlimit_steps_away) {
//Hit the wrong limit switch too many times
bufferWrite(output_buff, sizeof(output_buff), output_buffCount, F("< STEPPER ERROR LIMIT SWITCH (WAS MOVING AWAY)\n"));
bufferWrite(output_buff, sizeof(output_buff), output_buffCount, F("< STEPPER ERROR LIMIT SWITCH"));
bufferWrite(output_buff, sizeof(output_buff), output_buffCount, F(" MIN = "));
bufferWrite(output_buff, sizeof(output_buff), output_buffCount, onMIN?"1":"0");
bufferWrite(output_buff, sizeof(output_buff), output_buffCount, F(" MAX = "));
bufferWrite(output_buff, sizeof(output_buff), output_buffCount, onMAX?"1":"0");
bufferWrite(output_buff, sizeof(output_buff), output_buffCount, F(" (WAS MOVING AWAY FROM TRIGGERED SWITCH)\n"));
goto resetGO;
}
if(onLimitCount_towards > stepper_onlimit_steps_towards) {
@@ -142,11 +147,21 @@ void stepper_control() {
}
if(onLimitCount_towards > stepper_onlimit_steps_towards) {
bufferWrite(output_buff, sizeof(output_buff), output_buffCount, F("< STEPPER ERROR LIMIT SWITCH (WAS MOVING TOWARDS)\n"));
bufferWrite(output_buff, sizeof(output_buff), output_buffCount, F("< STEPPER ERROR LIMIT SWITCH"));
bufferWrite(output_buff, sizeof(output_buff), output_buffCount, F(" MIN = "));
bufferWrite(output_buff, sizeof(output_buff), output_buffCount, onMIN?"1":"0");
bufferWrite(output_buff, sizeof(output_buff), output_buffCount, F(" MAX = "));
bufferWrite(output_buff, sizeof(output_buff), output_buffCount, onMAX?"1":"0");
bufferWrite(output_buff, sizeof(output_buff), output_buffCount, F(" (WAS MOVING TOWARDS TRIGGERED SWITCH)\n"));
goto resetGO;
}
if(onLimitCount_away > stepper_onlimit_steps_away) {
bufferWrite(output_buff, sizeof(output_buff), output_buffCount, F("< STEPPER ERROR LIMIT SWITCH (WAS MOVING AWAY)\n"));
bufferWrite(output_buff, sizeof(output_buff), output_buffCount, F("< STEPPER ERROR LIMIT SWITCH"));
bufferWrite(output_buff, sizeof(output_buff), output_buffCount, F(" MIN = "));
bufferWrite(output_buff, sizeof(output_buff), output_buffCount, onMIN?"1":"0");
bufferWrite(output_buff, sizeof(output_buff), output_buffCount, F(" MAX = "));
bufferWrite(output_buff, sizeof(output_buff), output_buffCount, onMAX?"1":"0");
bufferWrite(output_buff, sizeof(output_buff), output_buffCount, F(" (WAS MOVING AWAY FROM TRIGGERED SWITCH)\n"));
goto resetGO;
}
Loading