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())