diff --git a/orbbec_camera/src/ob_camera_node.cpp b/orbbec_camera/src/ob_camera_node.cpp
index 13669378..60a86b1c 100644
--- a/orbbec_camera/src/ob_camera_node.cpp
+++ b/orbbec_camera/src/ob_camera_node.cpp
@@ -94,7 +94,12 @@ void OBCameraNode::setAndGetNodeParameter(
   }
 }
 
-OBCameraNode::~OBCameraNode() noexcept { clean(); }
+OBCameraNode::~OBCameraNode() noexcept {
+   if(diagnostic_timer_) {
+	   diagnostic_timer_->cancel();
+   }
+   clean();
+ }
 
 void OBCameraNode::rebootDevice() {
   RCLCPP_WARN_STREAM(logger_, "Reboot device");