Add M119 - return status of endstops

1 files changed, 26 insertions, 0 deletions

diff --git a/Tonokip_Firmware/Tonokip_Firmware.pde b/Tonokip_Firmware/Tonokip_Firmware.pde
index fc49da1..318ff74 100644
--- a/Tonokip_Firmware/Tonokip_Firmware.pde
+++ b/Tonokip_Firmware/Tonokip_Firmware.pde
@@ -783,6 +783,32 @@ inline void process_commands()
 	Serial.print("E:");
         Serial.println(current_e);
         break;
+      case 119: // M119
+      	#if (X_MIN_PIN > -1)
+      	Serial.print("x_min:");
+        Serial.println(digitalRead(X_MIN_PIN)?"H":"L");
+      	#endif
+      	#if (X_MAX_PIN > -1)
+      	Serial.print("x_max:");
+        Serial.println(digitalRead(X_MAX_PIN)?"H":"L");
+      	#endif
+      	#if (Y_MIN_PIN > -1)
+      	Serial.print("y_min:");
+        Serial.println(digitalRead(Y_MIN_PIN)?"H":"L");
+      	#endif
+      	#if (Y_MAX_PIN > -1)
+      	Serial.print("y_max:");
+        Serial.println(digitalRead(Y_MAX_PIN)?"H":"L");
+      	#endif
+      	#if (Z_MIN_PIN > -1)
+      	Serial.print("z_min:");
+        Serial.println(digitalRead(Z_MIN_PIN)?"H":"L");
+      	#endif
+      	#if (Z_MAX_PIN > -1)
+      	Serial.print("z_max:");
+        Serial.println(digitalRead(Z_MAX_PIN)?"H":"L");
+      	#endif
+      	break;
       #ifdef RAMP_ACCELERATION
       case 201: // M201
         if(code_seen('X')) x_steps_per_sqr_second = code_value() * x_steps_per_unit;