SITL: added in recursion check in timer_handler()

libraries/Desktop/support/sitl.cpp

@@ -228,13 +228,16 @@ static void sitl_simulator_output(void)
 static void timer_handler(int signum)
 {
 	static uint32_t last_update_count;
+	static bool in_timer;
 
-	if (_interrupts_are_blocked()) {
+	if (in_timer || _interrupts_are_blocked()) {
 		return;
 	}
 	uint8_t oldSREG = SREG;
 	cli();
 
+	in_timer = true;
+
 #ifndef __CYGWIN__
 	/* make sure we die if our parent dies */
 	if (kill(parent_pid, 0) != 0) {
@@ -267,11 +270,13 @@ static void timer_handler(int signum)
 	if (update_count == 0) {
 		sitl_update_gps(0, 0, 0, 0, 0, false);
 		SREG = oldSREG;
+		in_timer = false;
 		return;
 	}
 
 	if (update_count == last_update_count) {
 		SREG = oldSREG;
+		in_timer = false;
 		return;
 	}
 	last_update_count = update_count;
@@ -295,6 +300,7 @@ static void timer_handler(int signum)
 	timer_scheduler.run();
 
 	SREG = oldSREG;
+	in_timer = false;
 }