Follow googlecartographer/cartographer#462. (#486)
parent
5a2db79fc3
commit
af28b769b4
|
@ -196,9 +196,8 @@ void Run(const string& pose_graph_filename,
|
|||
ReadStaticTransformsFromUrdf(urdf_filename, &tf_buffer);
|
||||
}
|
||||
|
||||
const auto transform_interpolation_buffer =
|
||||
carto::transform::TransformInterpolationBuffer::FromTrajectory(
|
||||
trajectory_proto);
|
||||
const carto::transform::TransformInterpolationBuffer
|
||||
transform_interpolation_buffer(trajectory_proto);
|
||||
rosbag::Bag bag;
|
||||
bag.open(bag_filename, rosbag::bagmode::Read);
|
||||
rosbag::View view(bag);
|
||||
|
@ -211,15 +210,15 @@ void Run(const string& pose_graph_filename,
|
|||
if (message.isType<sensor_msgs::PointCloud2>()) {
|
||||
points_batch = HandleMessage(
|
||||
*message.instantiate<sensor_msgs::PointCloud2>(), tracking_frame,
|
||||
tf_buffer, *transform_interpolation_buffer);
|
||||
tf_buffer, transform_interpolation_buffer);
|
||||
} else if (message.isType<sensor_msgs::MultiEchoLaserScan>()) {
|
||||
points_batch = HandleMessage(
|
||||
*message.instantiate<sensor_msgs::MultiEchoLaserScan>(),
|
||||
tracking_frame, tf_buffer, *transform_interpolation_buffer);
|
||||
tracking_frame, tf_buffer, transform_interpolation_buffer);
|
||||
} else if (message.isType<sensor_msgs::LaserScan>()) {
|
||||
points_batch = HandleMessage(
|
||||
*message.instantiate<sensor_msgs::LaserScan>(), tracking_frame,
|
||||
tf_buffer, *transform_interpolation_buffer);
|
||||
tf_buffer, transform_interpolation_buffer);
|
||||
}
|
||||
if (points_batch != nullptr) {
|
||||
points_batch->trajectory_id = trajectory_id;
|
||||
|
|
|
@ -213,7 +213,8 @@ void Run(const std::vector<string>& bag_filenames) {
|
|||
}
|
||||
|
||||
// Ensure the clock is republished after the bag has been finished, during the
|
||||
// final optimization, serialization, and optional indefinite spinning at the end.
|
||||
// final optimization, serialization, and optional indefinite spinning at the
|
||||
// end.
|
||||
clock_republish_timer.start();
|
||||
node.RunFinalOptimization();
|
||||
|
||||
|
|
Loading…
Reference in New Issue