From 2ee8cf1cf08095693b168238a311b1caf8df1701 Mon Sep 17 00:00:00 2001
From: Anton Babushkin <anton.babushkin@me.com>
Date: Fri, 7 Mar 2014 23:28:38 +0400
Subject: [PATCH] sdlog2: bug fixed, sleep when idle too

---
 src/modules/sdlog2/sdlog2.c | 4 ++--
 1 file changed, 2 insertions(+), 2 deletions(-)

diff --git a/src/modules/sdlog2/sdlog2.c b/src/modules/sdlog2/sdlog2.c
index 200d70e93f..58890322be 100644
--- a/src/modules/sdlog2/sdlog2.c
+++ b/src/modules/sdlog2/sdlog2.c
@@ -893,6 +893,8 @@ int sdlog2_thread_main(int argc, char *argv[])
 	}
 
 	while (!main_thread_should_exit) {
+		usleep(sleep_delay);
+
 		/* --- VEHICLE COMMAND - LOG MANAGEMENT --- */
 		if (copy_if_updated(ORB_ID(vehicle_command), subs.cmd_sub, &buf.cmd)) {
 			handle_command(&buf.cmd);
@@ -1222,8 +1224,6 @@ int sdlog2_thread_main(int argc, char *argv[])
 
 		/* unlock, now the writer thread may run */
 		pthread_mutex_unlock(&logbuffer_mutex);
-
-		usleep(sleep_delay);
 	}
 
 	if (logging_enabled) {