diff --git a/src/bno055_imu_driver.cpp b/src/bno055_imu_driver.cpp
index ea6729ed32cb571d3f0c9f715471bc320a2d6758..83172a7df7b882f9859d01ac09df4fe97691bef5 100644
--- a/src/bno055_imu_driver.cpp
+++ b/src/bno055_imu_driver.cpp
@@ -490,6 +490,7 @@ void CBNO055IMUDriver::set_operation_mode(op_mode_t op_mode)
       {
         this->event_server->set_event(this->finish_thread_event_id);
         this->thread_server->end_thread(this->data_thread_id);
+        this->event_server->reset_event(this->finish_thread_event_id);
       }  
     } 
     else