From d077deb960697e2336fcc0d76d31e9772dd38f5e Mon Sep 17 00:00:00 2001
From: Clement <c.boesmier@aptatio.com>
Date: Fri, 17 Nov 2023 11:17:04 +0100
Subject: [PATCH] main test GRBL

---
 src/main.cpp | 8 ++++++--
 1 file changed, 6 insertions(+), 2 deletions(-)

diff --git a/src/main.cpp b/src/main.cpp
index 51ccc6e..1af44f2 100644
--- a/src/main.cpp
+++ b/src/main.cpp
@@ -58,10 +58,14 @@ void setup() {
     M5.Lcd.setCursor(50, 120);
     delay(1000);
     M5.Lcd.println("Control Motor");
-    init(100, 755.906, 50);
+    init(STEPER_SPEED, STEPER_PAS, STEPER_ACC);
 }
 
-
+void mouveForward(int mm = 5){
+    char* s = "";
+    printf(s, "G1 X%d", mm);
+    _GRBL.sendGcode(s);
+}
 
 void loop() {
     if (M5.BtnA.wasPressed())