add 10 second stop

ut-ras · Nov 21, 2024 · bfce107 · bfce107
1 parent e00b3e5
commit bfce107
Showing 1 changed file with 6 additions and 0 deletions.
diff --git a/ut-robomaster/src/subsystems/chassis/command_sentry_position.cpp b/ut-robomaster/src/subsystems/chassis/command_sentry_position.cpp
@@ -47,6 +47,12 @@ void CommandSentryPosition::execute()
         spin = 0.0f;
     }
 
+    // don't move for 10 sec
+    if (getTimeMilliseconds() - startup_time < 10000.f)
+    {
+        move = Vector2f(0.0f);
+    }
+
     if (drivers->isGameActive())
     {
         chassis->input(move, spin);