Print sendtime of messsages.
Change-Id: I42579bce6133a536df61da9355aed763a0b2e614
diff --git a/aos/common/controls/BUILD b/aos/common/controls/BUILD
index de100bb..2e7af21 100644
--- a/aos/common/controls/BUILD
+++ b/aos/common/controls/BUILD
@@ -78,12 +78,12 @@
'control_loop.h',
],
deps = [
- '//aos/common/messages:robot_state',
- '//aos/common/logging',
- '//aos/common:time',
':control_loop_queues',
+ '//aos/common/logging',
'//aos/common/logging:queue_logging',
+ '//aos/common/messages:robot_state',
'//aos/common/util:log_interval',
'//aos/common:queues',
+ '//aos/common:time',
],
)
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();
}