cartographer icon indicating copy to clipboard operation
cartographer copied to clipboard

pose_extrapolator.cc

Open xbcdbc opened this issue 4 years ago • 2 comments

At line 115,i see “const transform::Rigid3d odometry_pose_delta =odometry_data_newest.pose.inverse() * odometry_data_oldest.pose;” However,at line 178, i see “ angular_velocity_from_poses_ = transform::RotationQuaternionToAngleAxisVector( oldest_pose.rotation().inverse() * newest_pose.rotation()) / queue_delta;”,I think this code should be “ angular_velocity_from_poses_ = transform::RotationQuaternionToAngleAxisVector( newest_pose.rotation().inverse() * oldest_pose.rotation()) / queue_delta;”?wait for your ans,thanks.

xbcdbc avatar Jun 23 '20 03:06 xbcdbc

this question is for the file "pose_extrapolator.cc"

xbcdbc avatar Jun 23 '20 03:06 xbcdbc

because first case divide :odometry_time_delta const double odometry_time_delta = common::ToSeconds(odometry_data_oldest.time - odometry_data_newest.time);

but second case divide :queue_delta const double queue_delta = common::ToSeconds(newest_time - oldest_time);

vagrant-drift avatar Jul 07 '20 13:07 vagrant-drift