Print sendtime of messsages.
Change-Id: I42579bce6133a536df61da9355aed763a0b2e614
diff --git a/aos/common/controls/control_loop-tmpl.h b/aos/common/controls/control_loop-tmpl.h
index d6813fb..b2f85e7 100644
--- a/aos/common/controls/control_loop-tmpl.h
+++ b/aos/common/controls/control_loop-tmpl.h
@@ -2,8 +2,8 @@
#include <inttypes.h>
#include "aos/common/logging/logging.h"
-#include "aos/common/messages/robot_state.q.h"
#include "aos/common/logging/queue_logging.h"
+#include "aos/common/messages/robot_state.q.h"
namespace aos {
namespace controls {
@@ -88,6 +88,7 @@
control_loop_->output.MakeMessage();
RunIteration(goal, position, output.get(), status.get());
+ output->SetTimeToNow();
LOG_STRUCT(DEBUG, "output", *output);
output.Send();
} else {
@@ -96,6 +97,7 @@
ZeroOutputs();
}
+ status->SetTimeToNow();
LOG_STRUCT(DEBUG, "status", *status);
status.Send();
}