|
|
@@ -186,6 +186,18 @@ void appMode()
|
|
|
Serial.println(input);
|
|
|
return;
|
|
|
}
|
|
|
+ if (input == "RESET_THETA")
|
|
|
+ {
|
|
|
+ resetTheta(); // Reset currentTheta
|
|
|
+ Serial.println("THETA_RESET"); // Notify Python
|
|
|
+ Serial.println("READY");
|
|
|
+ return;
|
|
|
+ }
|
|
|
+ if (input == "HOME")
|
|
|
+ {
|
|
|
+ homing();
|
|
|
+ return;
|
|
|
+ }
|
|
|
|
|
|
// Example: The user calls "SET_SPEED 60" => 60% of maxSpeed
|
|
|
if (input.startsWith("SET_SPEED"))
|