diff --git a/modules/catkin_ws/src/VeloxProtocolLib/test/TerminalControl.cpp b/modules/catkin_ws/src/VeloxProtocolLib/test/TerminalControl.cpp
index ad6e0ee12f82f153b7e9fc85af1c0f5079f212f2..5aa457dcea22a49ca98cc732bc9a0e3e6380ef4e 100644
--- a/modules/catkin_ws/src/VeloxProtocolLib/test/TerminalControl.cpp
+++ b/modules/catkin_ws/src/VeloxProtocolLib/test/TerminalControl.cpp
@@ -40,6 +40,8 @@ int main(int argc, char ** argv)
             while (running)
             {
                 int distance = uss.getDistance();
+                if (distance > 20)
+                    conn->setSpeed(0);
 
                 if (!monitorUSS)
                     continue;