Open Changliu52 opened 7 years ago
Looks like the timestamp of the /stereo/get_IMU topic is empty:
header: seq: 12912 stamp: secs: 0 nsecs: 0 frame_id: '' orientation: x: 0.0 y: 0.0 z: 0.0 w: 0.0 orientation_covariance: [0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0] angular_velocity: x: 0.0760527560816 y: -0.130419781587 z: 0.0557414752105 angular_velocity_covariance: [0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0] linear_acceleration: x: -0.743569603796 y: -0.635892628695 z: 9.51446103084 linear_acceleration_covariance: [0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0]
Just add ros::time::now(); to header.stamp.
e.g. IMUValue.header.stamp = ros::Time::now();
Looks like the timestamp of the /stereo/get_IMU topic is empty:
header: seq: 12912 stamp: secs: 0 nsecs: 0 frame_id: '' orientation: x: 0.0 y: 0.0 z: 0.0 w: 0.0 orientation_covariance: [0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0] angular_velocity: x: 0.0760527560816 y: -0.130419781587 z: 0.0557414752105 angular_velocity_covariance: [0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0] linear_acceleration: x: -0.743569603796 y: -0.635892628695 z: 9.51446103084 linear_acceleration_covariance: [0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0]