From 4bf11ca06b578cfa47b3258659cc9f101f0c8bfe Mon Sep 17 00:00:00 2001 From: Andreas Bircher Date: Tue, 23 Feb 2016 08:53:25 +0100 Subject: [PATCH] adding the timestamp logging --- src/modules/sdlog2/sdlog2.c | 1 + src/modules/sdlog2/sdlog2_messages.h | 3 ++- 2 files changed, 3 insertions(+), 1 deletion(-) diff --git a/src/modules/sdlog2/sdlog2.c b/src/modules/sdlog2/sdlog2.c index 9563115d07..005a133c68 100644 --- a/src/modules/sdlog2/sdlog2.c +++ b/src/modules/sdlog2/sdlog2.c @@ -1943,6 +1943,7 @@ int sdlog2_thread_main(int argc, char *argv[]) /* --- CAMERA TRIGGER --- */ if (copy_if_updated(ORB_ID(camera_trigger), &subs.cam_trig_sub, &buf.camera_trigger)) { log_msg.msg_type = LOG_CAMT_MSG; + log_msg.body.log_CAMT.timestamp = buf.camera_trigger.timestamp; log_msg.body.log_CAMT.seq = buf.camera_trigger.seq; LOGBUFFER_WRITE_AND_COUNT(CAMT); } diff --git a/src/modules/sdlog2/sdlog2_messages.h b/src/modules/sdlog2/sdlog2_messages.h index cbceee35ee..f6f22c7546 100644 --- a/src/modules/sdlog2/sdlog2_messages.h +++ b/src/modules/sdlog2/sdlog2_messages.h @@ -511,6 +511,7 @@ struct log_CTS_s { /* --- CAMERA TRIGGER --- */ #define LOG_CAMT_MSG 48 struct log_CAMT_s { + uint64_t timestamp; uint32_t seq; }; @@ -591,7 +592,7 @@ static const struct log_format_s log_formats[] = { LOG_FORMAT(ENCD, "qfqf", "cnt0,vel0,cnt1,vel1"), LOG_FORMAT(TSYN, "Q", "TimeOffset"), LOG_FORMAT(MACS, "fff", "RRint,PRint,YRint"), - LOG_FORMAT(CAMT, "I", "seq"), + LOG_FORMAT(CAMT, "QI", "timestamp,seq"), /* system-level messages, ID >= 0x80 */ /* FMT: don't write format of format message, it's useless */