Add stepper MS3 support
Co-Authored-By: TheLongAndOnly <thelongandonly@users.noreply.github.com>
This commit is contained in:
		@@ -41,17 +41,21 @@ void GcodeSuite::M350() {
 | 
			
		||||
 | 
			
		||||
/**
 | 
			
		||||
 * M351: Toggle MS1 MS2 pins directly with axis codes X Y Z E B
 | 
			
		||||
 *       S# determines MS1 or MS2, X# sets the pin high/low.
 | 
			
		||||
 *       S# determines MS1, MS2 or MS3, X# sets the pin high/low.
 | 
			
		||||
 */
 | 
			
		||||
void GcodeSuite::M351() {
 | 
			
		||||
  if (parser.seenval('S')) switch (parser.value_byte()) {
 | 
			
		||||
    case 1:
 | 
			
		||||
      LOOP_XYZE(i) if (parser.seenval(axis_codes[i])) stepper.microstep_ms(i, parser.value_byte(), -1);
 | 
			
		||||
      if (parser.seenval('B')) stepper.microstep_ms(4, parser.value_byte(), -1);
 | 
			
		||||
      LOOP_XYZE(i) if (parser.seenval(axis_codes[i])) stepper.microstep_ms(i, parser.value_byte(), -1, -1);
 | 
			
		||||
      if (parser.seenval('B')) stepper.microstep_ms(4, parser.value_byte(), -1, -1);
 | 
			
		||||
      break;
 | 
			
		||||
    case 2:
 | 
			
		||||
      LOOP_XYZE(i) if (parser.seenval(axis_codes[i])) stepper.microstep_ms(i, -1, parser.value_byte());
 | 
			
		||||
      if (parser.seenval('B')) stepper.microstep_ms(4, -1, parser.value_byte());
 | 
			
		||||
      LOOP_XYZE(i) if (parser.seenval(axis_codes[i])) stepper.microstep_ms(i, -1, parser.value_byte(), -1);
 | 
			
		||||
      if (parser.seenval('B')) stepper.microstep_ms(4, -1, parser.value_byte(), -1);
 | 
			
		||||
      break;
 | 
			
		||||
    case 3:
 | 
			
		||||
      LOOP_XYZE(i) if (parser.seenval(axis_codes[i])) stepper.microstep_ms(i, -1, -1, parser.value_byte());
 | 
			
		||||
      if (parser.seenval('B')) stepper.microstep_ms(4, -1, -1, parser.value_byte());
 | 
			
		||||
      break;
 | 
			
		||||
  }
 | 
			
		||||
  stepper.microstep_readings();
 | 
			
		||||
 
 | 
			
		||||
		Reference in New Issue
	
	Block a user