From 426903c617c25ae9ba99809d8a22987acc1bfb08 Mon Sep 17 00:00:00 2001
From: Mark Whitehorn <kd0aij@gmail.com>
Date: Mon, 8 Feb 2016 12:43:40 -0700
Subject: [PATCH] run astyle

---
 src/drivers/px4fmu/fmu.cpp | 4 +++-
 1 file changed, 3 insertions(+), 1 deletion(-)

diff --git a/src/drivers/px4fmu/fmu.cpp b/src/drivers/px4fmu/fmu.cpp
index 8dda9b6a4f..db21ff9fe0 100644
--- a/src/drivers/px4fmu/fmu.cpp
+++ b/src/drivers/px4fmu/fmu.cpp
@@ -481,6 +481,7 @@ PX4FMU:: safety_check_button(void)
 			_safety_off = false;
 			counter++;
 		}
+
 	} else {
 		counter = 0;
 	}
@@ -963,7 +964,8 @@ PX4FMU::cycle()
 
 					/* main outputs */
 					if (i == 0) {
-						//main_out_latency = hrt_absolute_time() - _controls[i].timestamp - 250;
+//						main_out_latency = hrt_absolute_time() - _controls[i].timestamp - 250;
+						warnx("lat: %llu", hrt_absolute_time() - _controls[i].timestamp);
 
 						/* do only correct within the current phase */
 						if (abs(main_out_latency) > SCHEDULE_INTERVAL) {