diff --git a/include/controller.hpp b/include/controller.hpp
index 15b6a6c..895e7f8 100644
--- a/include/controller.hpp
+++ b/include/controller.hpp
@@ -61,7 +61,7 @@ public:
     bool ClassicWalk(bool flag);
     bool WalkUpright(bool flag);
     bool CrossStep(bool flag);
-    bool TrajectoryFollow(const std::vector<unitree::robot::go2::PathPoint>& path);
+    bool TrajectoryFollow(std::vector<unitree::robot::go2::PathPoint>& path);
     
     // Obstacle 
     bool SwitchSet(bool enable);
diff --git a/src/controller.cpp b/src/controller.cpp
index eb0e015..dd0760e 100644
--- a/src/controller.cpp
+++ b/src/controller.cpp
@@ -339,7 +339,7 @@ bool Controller::CrossStep(bool flag) {
     });
 }
 
-bool Controller::TrajectoryFollow(const std::vector<unitree::robot::go2::PathPoint>& path) {
+bool Controller::TrajectoryFollow(std::vector<unitree::robot::go2::PathPoint>& path) {
     return ExecuteSportCmd([&path](auto* sc) {
         return sc->TrajectoryFollow(path);
     });