diff --git a/src/custom_robot.cpp b/src/custom_robot.cpp
index 20185b2..3026849 100644
--- a/src/custom_robot.cpp
+++ b/src/custom_robot.cpp
@@ -143,7 +143,6 @@ CustomRobot::~CustomRobot() {
     }
     
     if (recharge_) {
-        recharge_->Close();
         recharge_.reset();
     }
     
@@ -283,7 +282,6 @@ void CustomRobot::stopTraj()
         LOG_INFO("Stopping dynamic trajectory control...");
         traj_running_ = false;
         if (traj_th_) {
-            traj_th_->Stop();
             traj_th_.reset();
         }
     }