From 773528499e4ff1f3ba67351a0f202342041437eb Mon Sep 17 00:00:00 2001 From: Yu Asabe Date: Sun, 5 Dec 2021 14:17:08 +0900 Subject: [PATCH] Add gdt log --- src/v2x_app.cpp | 3 ++- 1 file changed, 2 insertions(+), 1 deletion(-) diff --git a/src/v2x_app.cpp b/src/v2x_app.cpp index c6b18a5..e6be106 100644 --- a/src/v2x_app.cpp +++ b/src/v2x_app.cpp @@ -56,8 +56,9 @@ namespace v2x int gdt_timestamp_sec = msg->transforms[0].header.stamp.sec; // seconds int gdt_timestamp_nsec = msg->transforms[0].header.stamp.nanosec; // nanoseconds long long gdt_timestamp = gdt_timestamp_sec * 1e9 + gdt_timestamp_nsec; // nanoseconds - int gdt_timestamp_msec = gdt_timestamp / 1e6; + long long gdt_timestamp_msec = gdt_timestamp / 1000000; int gdt = gdt_timestamp_msec % 65536; // milliseconds + RCLCPP_INFO(node_->get_logger(), "gdt %d, gdt_timestamp %ld, gdt_timestamp_msec %ld", gdt, gdt_timestamp, gdt_timestamp_msec); double rot_x = msg->transforms[0].transform.rotation.x; double rot_y = msg->transforms[0].transform.rotation.y;