From cb6bb41ea9dc2b079a9364cb06a0747eb767294b Mon Sep 17 00:00:00 2001
From: Sergi Hernandez Juan <shernand@iri.upc.edu>
Date: Tue, 4 Feb 2020 08:42:00 +0100
Subject: [PATCH] Solved a bug: the finish thread signal was not reset after
 stopping the thread, and it made the thread finish immediatelly after the
 first time.

---
 src/bno055_imu_driver.cpp | 1 +
 1 file changed, 1 insertion(+)

diff --git a/src/bno055_imu_driver.cpp b/src/bno055_imu_driver.cpp
index ea6729e..83172a7 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
-- 
GitLab