diff --git a/src/modules/sih/sih.cpp b/src/modules/sih/sih.cpp
index 5aa3ba174a..31ff81b720 100644
--- a/src/modules/sih/sih.cpp
+++ b/src/modules/sih/sih.cpp
@@ -227,6 +227,7 @@ void Sih::run()
         perf_end(_loop_perf);
     }
 
+    px4_sem_destroy(&_data_semaphore);
 	hrt_cancel(&_timer_call); 	// close the periodic timer interruption
 	orb_unsubscribe(_actuator_out_sub);
 	orb_unsubscribe(_parameter_update_sub);