cartographer 代码思想解读(12)- local SLAM和global SLAM链接global_trajectory_builder

本文主要分析2D SLAM中GlobalTrajectoryBuilder2D的创建,介绍其构造函数和成员变量。阐述加入传感器数据接口,包括IMU、odometer、绝对位置传感器等,重点讲解点云传感器传入这一核心功能。通过调用前端接口匹配,将结果加入后端优化,最终完成整个SLAM流程。


从上节map_builder代码分析可看出,cartographer SLAM和传统SLAM一致,分为前端和后端两部分:local_trajectory_builder和pose_graph,而将两者如何结合在一起,则采用了GlobalTrajectoryBuilder类进行封装。其功能是将localslam的一些定位和submap信息,送给后端优化pose_graph,从而完成闭环和优化,从而完成整个SLAM。

GlobalTrajectoryBuilder2D 创建

由于只分析2d SLAM的情况,因此可针对2d的情况进行创建。采用LocalTrajectoryBuilder2D前端类和PoseGraph2D后端类。

	std::unique_ptr<TrajectoryBuilderInterface> CreateGlobalTrajectoryBuilder2D(
    std::unique_ptr<LocalTrajectoryBuilder2D> local_trajectory_builder,
    const int trajectory_id, mapping::PoseGraph2D* const pose_graph,
    const TrajectoryBuilderInterface::LocalSlamResultCallback&
        local_slam_result_callback) {
  return absl::make_unique<
      GlobalTrajectoryBuilder<LocalTrajectoryBuilder2D, mapping::PoseGraph2D>>(
      std::move(local_trajectory_builder), trajectory_id, pose_graph,
      local_slam_result_callback);
}

GlobalTrajectoryBuilder 构造函数和成员变量

  const int trajectory_id_;                                           // 当前轨迹ID
  PoseGraph* const pose_graph_;                                       // 全局图优化即约束
  std::unique_ptr<LocalTrajectoryBuilder> local_trajectory_builder_;  // 局部规划器,即local slam
  LocalSlamResultCallback local_slam_result_callback_;                // 结果回调器

非常清楚简单,完成指定ID轨迹中前端和后端的联系,因此需要获取trajectory的ID。
其中pose_graph_采用的2d的闭环类。
LocalTrajectoryBuilder采用的是2的轨迹跟踪器LocalTrajectoryBuilder2D。

  GlobalTrajectoryBuilder(
      std::unique_ptr<LocalTrajectoryBuilder> local_trajectory_builder,
      const int
[INFO] [launch]: All log files can be found below /home/michael/.ros/log/2025-11-13-20-58-01-810975-michael-Legion-Y7000-IRX9-19250 [INFO] [launch]: Default logging verbosity is set to INFO [INFO] [ldlidar-1]: process started with pid [19251] [INFO] [static_transform_publisher-2]: process started with pid [19253] [INFO] [cartographer_node-3]: process started with pid [19255] [INFO] [cartographer_occupancy_grid_node-4]: process started with pid [19257] [ldlidar-1] [INFO] [1763038681.848068170] [rclcpp]: Using port /dev/ttyUSB0 [ldlidar-1] [INFO] [1763038681.848215863] [rclcpp]: LiDAR_LD06 started successfully [static_transform_publisher-2] [INFO] [1763038681.854935283] [static_transform_publisher_rhh6TZQasS30xSPv]: Spinning until stopped - publishing transform [static_transform_publisher-2] translation: ('0.000000', '0.000000', '0.000000') [static_transform_publisher-2] rotation: ('0.000000', '0.000000', '0.000000', '1.000000') [static_transform_publisher-2] from 'base_link' to 'laser' [cartographer_node-3] [INFO] [1763038681.866653454] [cartographer logger]: I1113 20:58:01.000000 19255 configuration_file_resolver.cc:41] Found '/home/michael/ros2_ws/install/ldlidar-ros2/share/ldlidar-ros2/configuration_files/mylaser.lua' for 'mylaser.lua'. [cartographer_node-3] [INFO] [1763038681.866834936] [cartographer logger]: I1113 20:58:01.000000 19255 configuration_file_resolver.cc:41] Found '/opt/ros/humble/share/cartographer/configuration_files/map_builder.lua' for 'map_builder.lua'. [cartographer_node-3] [INFO] [1763038681.866843969] [cartographer logger]: I1113 20:58:01.000000 19255 configuration_file_resolver.cc:41] Found '/opt/ros/humble/share/cartographer/configuration_files/map_builder.lua' for 'map_builder.lua'. [cartographer_node-3] [INFO] [1763038681.866860499] [cartographer logger]: I1113 20:58:01.000000 19255 configuration_file_resolver.cc:41] Found '/opt/ros/humble/share/cartographer/configuration_files/pose_graph.lua' for 'pose_graph.lua'. [cartographer_node-3] [INFO] [1763038681.866866271] [cartographer logger]: I1113 20:58:01.000000 19255 configuration_file_resolver.cc:41] Found '/opt/ros/humble/share/cartographer/configuration_files/pose_graph.lua' for 'pose_graph.lua'. [cartographer_node-3] [INFO] [1763038681.866925744] [cartographer logger]: I1113 20:58:01.000000 19255 configuration_file_resolver.cc:41] Found '/opt/ros/humble/share/cartographer/configuration_files/trajectory_builder.lua' for 'trajectory_builder.lua'. [cartographer_node-3] [INFO] [1763038681.866931863] [cartographer logger]: I1113 20:58:01.000000 19255 configuration_file_resolver.cc:41] Found '/opt/ros/humble/share/cartographer/configuration_files/trajectory_builder.lua' for 'trajectory_builder.lua'. [cartographer_node-3] [INFO] [1763038681.866948391] [cartographer logger]: I1113 20:58:01.000000 19255 configuration_file_resolver.cc:41] Found '/opt/ros/humble/share/cartographer/configuration_files/trajectory_builder_2d.lua' for 'trajectory_builder_2d.lua'. [cartographer_node-3] [INFO] [1763038681.866953836] [cartographer logger]: I1113 20:58:01.000000 19255 configuration_file_resolver.cc:41] Found '/opt/ros/humble/share/cartographer/configuration_files/trajectory_builder_2d.lua' for 'trajectory_builder_2d.lua'. [cartographer_node-3] [INFO] [1763038681.867004255] [cartographer logger]: I1113 20:58:01.000000 19255 configuration_file_resolver.cc:41] Found '/opt/ros/humble/share/cartographer/configuration_files/trajectory_builder_3d.lua' for 'trajectory_builder_3d.lua'. [cartographer_node-3] [INFO] [1763038681.867010139] [cartographer logger]: I1113 20:58:01.000000 19255 configuration_file_resolver.cc:41] Found '/opt/ros/humble/share/cartographer/configuration_files/trajectory_builder_3d.lua' for 'trajectory_builder_3d.lua'. [cartographer_node-3] F1113 20:58:01.867271 19255 lua_parameter_dictionary.cc:399] Check failed: HasKey(key) Key 'rangefinder_sampling_ratio' not in dictionary: [cartographer_node-3] { [cartographer_node-3] lookup_transform_timeout_sec = 0.200000, [cartographer_node-3] map_builder = { [cartographer_node-3] collate_by_trajectory = false, [cartographer_node-3] num_background_threads = 4.000000, [cartographer_node-3] pose_graph = { [cartographer_node-3] constraint_builder = { [cartographer_node-3] ceres_scan_matcher = { [cartographer_node-3] ceres_solver_options = { [cartographer_node-3] max_num_iterations = 10.000000, [cartographer_node-3] num_threads = 1.000000, [cartographer_node-3] use_nonmonotonic_steps = true, [cartographer_node-3] }, [cartographer_node-3] occupied_space_weight = 20.000000, [cartographer_node-3] rotation_weight = 1.000000, [cartographer_node-3] translation_weight = 10.000000, [cartographer_node-3] }, [cartographer_node-3] ceres_scan_matcher_3d = { [cartographer_node-3] ceres_solver_options = { [cartographer_node-3] max_num_iterations = 10.000000, [cartographer_node-3] num_threads = 1.000000, [cartographer_node-3] use_nonmonotonic_steps = false, [cartographer_node-3] }, [cartographer_node-3] occupied_space_weight_0 = 5.000000, [cartographer_node-3] occupied_space_weight_1 = 30.000000, [cartographer_node-3] only_optimize_yaw = false, [cartographer_node-3] rotation_weight = 1.000000, [cartographer_node-3] translation_weight = 10.000000, [cartographer_node-3] }, [cartographer_node-3] fast_correlative_scan_matcher = { [cartographer_node-3] angular_search_window = 0.523599, [cartographer_node-3] branch_and_bound_depth = 7.000000, [cartographer_node-3] linear_search_window = 7.000000, [cartographer_node-3] }, [cartographer_node-3] fast_correlative_scan_matcher_3d = { [cartographer_node-3] angular_search_window = 0.261799, [cartographer_node-3] branch_and_bound_depth = 8.000000, [cartographer_node-3] full_resolution_depth = 3.000000, [cartographer_node-3] linear_xy_search_window = 5.000000, [cartographer_node-3] linear_z_search_window = 1.000000, [cartographer_node-3] min_low_resolution_score = 0.550000, [cartographer_node-3] min_rotational_score = 0.770000, [cartographer_node-3] }, [cartographer_node-3] global_localization_min_score = 0.600000, [cartographer_node-3] log_matches = true, [cartographer_node-3] loop_closure_rotation_weight = 100000.000000, [cartographer_node-3] loop_closure_translation_weight = 11000.000000, [cartographer_node-3] max_constraint_distance = 15.000000, [cartographer_node-3] min_score = 0.650000, [cartographer_node-3] sampling_ratio = 0.300000, [cartographer_node-3] }, [cartographer_node-3] global_constraint_search_after_n_seconds = 10.000000, [cartographer_node-3] global_sampling_ratio = 0.003000, [cartographer_node-3] log_residual_histograms = true, [cartographer_node-3] matcher_rotation_weight = 1600.000000, [cartographer_node-3] matcher_translation_weight = 500.000000, [cartographer_node-3] max_num_final_iterations = 200.000000, [cartographer_node-3] optimization_problem = { [cartographer_node-3] acceleration_weight = 110.000000, [cartographer_node-3] ceres_solver_options = { [cartographer_node-3] max_num_iterations = 50.000000, [cartographer_node-3] num_threads = 7.000000, [cartographer_node-3] use_nonmonotonic_steps = false, [cartographer_node-3] }, [cartographer_node-3] fix_z_in_3d = false, [cartographer_node-3] fixed_frame_pose_rotation_weight = 100.000000, [cartographer_node-3] fixed_frame_pose_tolerant_loss_param_a = 1.000000, [cartographer_node-3] fixed_frame_pose_tolerant_loss_param_b = 1.000000, [cartographer_node-3] fixed_frame_pose_translation_weight = 10.000000, [cartographer_node-3] fixed_frame_pose_use_tolerant_loss = false, [cartographer_node-3] huber_scale = 100.000000, [cartographer_node-3] local_slam_pose_rotation_weight = 100000.000000, [cartographer_node-3] local_slam_pose_translation_weight = 100000.000000, [cartographer_node-3] log_solver_summary = false, [cartographer_node-3] odometry_rotation_weight = 100000.000000, [cartographer_node-3] odometry_translation_weight = 100000.000000, [cartographer_node-3] rotation_weight = 16000.000000, [cartographer_node-3] use_online_imu_extrinsics_in_3d = true, [cartographer_node-3] }, [cartographer_node-3] optimize_every_n_nodes = 35.000000, [cartographer_node-3] }, [cartographer_node-3] use_trajectory_builder_2d = true, [cartographer_node-3] use_trajectory_builder_3d = false, [cartographer_node-3] }, [cartographer_node-3] map_frame = "map", [cartographer_node-3] num_laser_scans = 1.000000, [cartographer_node-3] num_multi_echo_laser_scans = 0.000000, [cartographer_node-3] num_point_clouds = 0.000000, [cartographer_node-3] num_subdivisions_per_laser_scan = 1.000000, [cartographer_node-3] odom_frame = "odom", [cartographer_node-3] pose_publish_period_sec = 0.005000, [cartographer_node-3] provide_odom_frame = false, [cartographer_node-3] publish_frame_projected_to_2d = false, [cartographer_node-3] published_frame = "laser", [cartographer_node-3] submap_publish_period_sec = 0.300000, [cartographer_node-3] tracking_frame = "laser", [cartographer_node-3] trajectory_builder = { [cartographer_node-3] collate_fixed_frame = true, [cartographer_node-3] collate_landmarks = false, [cartographer_node-3] trajectory_builder_2d = { [cartographer_node-3] adaptive_voxel_filter = { [cartographer_node-3] max_length = 0.500000, [cartographer_node-3] max_range = 50.000000, [cartographer_node-3] min_num_points = 200.000000, [cartographer_node-3] }, [cartographer_node-3] ceres_scan_matcher = { [cartographer_node-3] ceres_solver_options = { [cartographer_node-3] max_num_iterations = 20.000000, [cartographer_node-3] num_threads = 1.000000, [cartographer_node-3] use_nonmonotonic_steps = false, [cartographer_node-3] }, [cartographer_node-3] occupied_space_weight = 1.000000, [cartographer_node-3] rotation_weight = 40.000000, [cartographer_node-3] translation_weight = 10.000000, [cartographer_node-3] }, [cartographer_node-3] imu_gravity_time_constant = 10.000000, [cartographer_node-3] loop_closure_adaptive_voxel_filter = { [cartographer_node-3] max_length = 0.900000, [cartographer_node-3] max_range = 50.000000, [cartographer_node-3] min_num_points = 100.000000, [cartographer_node-3] }, [cartographer_node-3] max_range = 12.000000, [cartographer_node-3] max_z = 2.000000, [cartographer_node-3] min_range = 0.100000, [cartographer_node-3] min_z = -0.800000, [cartographer_node-3] missing_data_ray_length = 5.000000, [cartographer_node-3] motion_filter = { [cartographer_node-3] max_angle_radians = 0.017453, [cartographer_node-3] max_distance_meters = 0.200000, [cartographer_node-3] max_time_seconds = 5.000000, [cartographer_node-3] }, [cartographer_node-3] num_accumulated_range_data = 1.000000, [cartographer_node-3] pose_extrapolator = { [cartographer_node-3] constant_velocity = { [cartographer_node-3] imu_gravity_time_constant = 10.000000, [cartographer_node-3] pose_queue_duration = 0.001000, [cartographer_node-3] }, [cartographer_node-3] imu_based = { [cartographer_node-3] gravity_constant = 9.806000, [cartographer_node-3] imu_acceleration_weight = 1.000000, [cartographer_node-3] imu_rotation_weight = 1.000000, [cartographer_node-3] odometry_rotation_weight = 1.000000, [cartographer_node-3] odometry_translation_weight = 1.000000, [cartographer_node-3] pose_queue_duration = 5.000000, [cartographer_node-3] pose_rotation_weight = 1.000000, [cartographer_node-3] pose_translation_weight = 1.000000, [cartographer_node-3] solver_options = { [cartographer_node-3] max_num_iterations = 10.000000, [cartographer_node-3] num_threads = 1.000000, [cartographer_node-3] use_nonmonotonic_steps = false, [cartographer_node-3] }, [cartographer_node-3] }, [cartographer_node-3] use_imu_based = false, [cartographer_node-3] }, [cartographer_node-3] real_time_correlative_scan_matcher = { [cartographer_node-3] angular_search_window = 0.349066, [cartographer_node-3] linear_search_window = 0.100000, [cartographer_node-3] rotation_delta_cost_weight = 0.100000, [cartographer_node-3] translation_delta_cost_weight = 10.000000, [cartographer_node-3] }, [cartographer_node-3] submaps = { [cartographer_node-3] grid_options_2d = { [cartographer_node-3] grid_type = "PROBABILITY_GRID", [cartographer_node-3] resolution = 0.050000, [cartographer_node-3] }, [cartographer_node-3] num_range_data = 35.000000, [cartographer_node-3] range_data_inserter = { [cartographer_node-3] probability_grid_range_data_inserter = { [cartographer_node-3] hit_probability = 0.550000, [cartographer_node-3] insert_free_space = true, [cartographer_node-3] miss_probability = 0.490000, [cartographer_node-3] }, [cartographer_node-3] range_data_inserter_type = "PROBABILITY_GRID_INSERTER_2D", [cartographer_node-3] tsdf_range_data_inserter = { [cartographer_node-3] maximum_weight = 10.000000, [cartographer_node-3] normal_estimation_options = { [cartographer_node-3] num_normal_samples = 4.000000, [cartographer_node-3] sample_radius = 0.500000, [cartographer_node-3] }, [cartographer_node-3] project_sdf_distance_to_scan_normal = true, [cartographer_node-3] truncation_distance = 0.300000, [cartographer_node-3] update_free_space = false, [cartographer_node-3] update_weight_angle_scan_normal_to_ray_kernel_bandwidth = 0.500000, [cartographer_node-3] update_weight_distance_cell_to_hit_kernel_bandwidth = 0.500000, [cartographer_node-3] update_weight_range_exponent = 0.000000, [cartographer_node-3] }, [cartographer_node-3] }, [cartographer_node-3] }, [cartographer_node-3] use_imu_data = false, [cartographer_node-3] use_online_correlative_scan_matching = true, [cartographer_node-3] voxel_filter_size = 0.025000, [cartographer_node-3] }, [cartographer_node-3] trajectory_builder_3d = { [cartographer_node-3] ceres_scan_matcher = { [cartographer_node-3] ceres_solver_options = { [cartographer_node-3] max_num_iterations = 12.000000, [cartographer_node-3] num_threads = 1.000000, [cartographer_node-3] use_nonmonotonic_steps = false, [cartographer_node-3] }, [cartographer_node-3] intensity_cost_function_options_0 = { [cartographer_node-3] huber_scale = 0.300000, [cartographer_node-3] intensity_threshold = 40.000000, [cartographer_node-3] weight = 0.500000, [cartographer_node-3] }, [cartographer_node-3] occupied_space_weight_0 = 1.000000, [cartographer_node-3] occupied_space_weight_1 = 6.000000, [cartographer_node-3] only_optimize_yaw = false, [cartographer_node-3] rotation_weight = 400.000000, [cartographer_node-3] translation_weight = 5.000000, [cartographer_node-3] }, [cartographer_node-3] high_resolution_adaptive_voxel_filter = { [cartographer_node-3] max_length = 2.000000, [cartographer_node-3] max_range = 15.000000, [cartographer_node-3] min_num_points = 150.000000, [cartographer_node-3] }, [cartographer_node-3] imu_gravity_time_constant = 10.000000, [cartographer_node-3] low_resolution_adaptive_voxel_filter = { [cartographer_node-3] max_length = 4.000000, [cartographer_node-3] max_range = 60.000000, [cartographer_node-3] min_num_points = 200.000000, [cartographer_node-3] }, [cartographer_node-3] max_range = 60.000000, [cartographer_node-3] min_range = 1.000000, [cartographer_node-3] motion_filter = { [cartographer_node-3] max_angle_radians = 0.004000, [cartographer_node-3] max_distance_meters = 0.100000, [cartographer_node-3] max_time_seconds = 0.500000, [cartographer_node-3] }, [cartographer_node-3] num_accumulated_range_data = 1.000000, [cartographer_node-3] pose_extrapolator = { [cartographer_node-3] constant_velocity = { [cartographer_node-3] imu_gravity_time_constant = 10.000000, [cartographer_node-3] pose_queue_duration = 0.001000, [cartographer_node-3] }, [cartographer_node-3] imu_based = { [cartographer_node-3] gravity_constant = 9.806000, [cartographer_node-3] imu_acceleration_weight = 1.000000, [cartographer_node-3] imu_rotation_weight = 1.000000, [cartographer_node-3] odometry_rotation_weight = 1.000000, [cartographer_node-3] odometry_translation_weight = 1.000000, [cartographer_node-3] pose_queue_duration = 5.000000, [cartographer_node-3] pose_rotation_weight = 1.000000, [cartographer_node-3] pose_translation_weight = 1.000000, [cartographer_node-3] solver_options = { [cartographer_node-3] max_num_iterations = 10.000000, [cartographer_node-3] num_threads = 1.000000, [cartographer_node-3] use_nonmonotonic_steps = false, [cartographer_node-3] }, [cartographer_node-3] }, [cartographer_node-3] use_imu_based = false, [cartographer_node-3] }, [cartographer_node-3] real_time_correlative_scan_matcher = { [cartographer_node-3] angular_search_window = 0.017453, [cartographer_node-3] linear_search_window = 0.150000, [cartographer_node-3] rotation_delta_cost_weight = 0.100000, [cartographer_node-3] translation_delta_cost_weight = 0.100000, [cartographer_node-3] }, [cartographer_node-3] rotational_histogram_size = 120.000000, [cartographer_node-3] submaps = { [cartographer_node-3] high_resolution = 0.100000, [cartographer_node-3] high_resolution_max_range = 20.000000, [cartographer_node-3] low_resolution = 0.450000, [cartographer_node-3] num_range_data = 160.000000, [cartographer_node-3] range_data_inserter = { [cartographer_node-3] hit_probability = 0.550000, [cartographer_node-3] intensity_threshold = 40.000000, [cartographer_node-3] miss_probability = 0.490000, [cartographer_node-3] num_free_space_voxels = 2.000000, [cartographer_node-3] }, [cartographer_node-3] }, [cartographer_node-3] use_intensities = false, [cartographer_node-3] use_online_correlative_scan_matching = false, [cartographer_node-3] voxel_filter_size = 0.150000, [cartographer_node-3] }, [cartographer_node-3] }, [cartographer_node-3] trajectory_publish_period_sec = 0.030000, [cartographer_node-3] use_landmarks = false, [cartographer_node-3] use_nav_sat = false, [cartographer_node-3] use_odometry = false, [cartographer_node-3] use_pose_extrapolator = false, [cartographer_node-3] } [cartographer_node-3] [FATAL] [1763038681.867573928] [cartographer logger]: F1113 20:58:01.000000 19255 lua_parameter_dictionary.cc:399] Check failed: HasKey(key) Key 'rangefinder_sampling_ratio' not in dictionary: [cartographer_node-3] { [cartographer_node-3] lookup_transform_timeout_sec = 0.200000, [cartographer_node-3] map_builder = { [cartographer_node-3] collate_by_trajectory = false, [cartographer_node-3] num_background_threads = 4.000000, [cartographer_node-3] pose_graph = { [cartographer_node-3] constraint_builder = { [cartographer_node-3] ceres_scan_matcher = { [cartographer_node-3] ceres_solver_options = { [cartographer_node-3] max_num_iterations = 10.000000, [cartographer_node-3] num_threads = 1.000000, [cartographer_node-3] use_nonmonotonic_steps = true, [cartographer_node-3] }, [cartographer_node-3] occupied_space_weight = 20.000000, [cartographer_node-3] rotation_weight = 1.000000, [cartographer_node-3] translation_weight = 10.000000, [cartographer_node-3] }, [cartographer_node-3] ceres_scan_matcher_3d = { [cartographer_node-3] ceres_solver_options = { [cartographer_node-3] max_num_iterations = 10.000000, [cartographer_node-3] num_threads = 1.000000, [cartographer_node-3] use_nonmonotonic_steps = false, [cartographer_node-3] }, [cartographer_node-3] occupied_space_weight_0 = 5.000000, [cartographer_node-3] occupied_space_weight_1 = 30.000000, [cartographer_node-3] only_optimize_yaw = false, [cartographer_node-3] rotation_weight = 1.000000, [cartographer_node-3] translation_weight = 10.000000, [cartographer_node-3] }, [cartographer_node-3] fast_correlative_scan_matcher = { [cartographer_node-3] angular_search_window = 0.523599, [cartographer_node-3] branch_and_bound_depth = 7.000000, [cartographer_node-3] linear_search_window = 7.000000, [cartographer_node-3] }, [cartographer_node-3] fast_correlative_scan_matcher_3d = { [cartographer_node-3] angular_search_window = 0.261799, [cartographer_node-3] branch_and_bound_depth = 8.000000, [cartographer_node-3] full_resolution_depth = 3.000000, [cartographer_node-3] linear_xy_search_window = 5.000000, [cartographer_node-3] linear_z_search_window = 1.000000, [cartographer_node-3] min_low_resolution_score = 0.550000, [cartographer_node-3] min_rotational_score = 0.770000, [cartographer_node-3] }, [cartographer_node-3] global_localization_min_score = 0.600000, [cartographer_node-3] log_matches = true, [cartographer_node-3] loop_closure_rotation_weight = 100000.000000, [cartographer_node-3] loop_closure_translation_weight = 11000.000000, [cartographer_node-3] max_constraint_distance = 15.000000, [cartographer_node-3] min_score = 0.650000, [cartographer_node-3] sampling_ratio = 0.300000, [cartographer_node-3] }, [cartographer_node-3] global_constraint_search_after_n_seconds = 10.000000, [cartographer_node-3] global_sampling_ratio = 0.003000, [cartographer_node-3] log_residual_histograms = true, [cartographer_node-3] matcher_rotation_weight = 1600.000000, [cartographer_node-3] matcher_translation_weight = 500.000000, [cartographer_node-3] max_num_final_iterations = 200.000000, [cartographer_node-3] optimization_problem = { [cartographer_node-3] acceleration_weight = 110.000000, [cartographer_node-3] ceres_solver_options = { [cartographer_node-3] max_num_iterations = 50.000000, [cartographer_node-3] num_threads = 7.000000, [cartographer_node-3] use_nonmonotonic_steps = false, [cartographer_node-3] }, [cartographer_node-3] fix_z_in_3d = false, [cartographer_node-3] fixed_frame_pose_rotation_weight = 100.000000, [cartographer_node-3] fixed_frame_pose_tolerant_loss_param_a = 1.000000, [cartographer_node-3] fixed_frame_pose_tolerant_loss_param_b = 1.000000, [cartographer_node-3] fixed_frame_pose_translation_weight = 10.000000, [cartographer_node-3] fixed_frame_pose_use_tolerant_loss = false, [cartographer_node-3] huber_scale = 100.000000, [cartographer_node-3] local_slam_pose_rotation_weight = 100000.000000, [cartographer_node-3] local_slam_pose_translation_weight = 100000.000000, [cartographer_node-3] log_solver_summary = false, [cartographer_node-3] odometry_rotation_weight = 100000.000000, [cartographer_node-3] odometry_translation_weight = 100000.000000, [cartographer_node-3] rotation_weight = 16000.000000, [cartographer_node-3] use_online_imu_extrinsics_in_3d = true, [cartographer_node-3] }, [cartographer_node-3] optimize_every_n_nodes = 35.000000, [cartographer_node-3] }, [cartographer_node-3] use_trajectory_builder_2d = true, [cartographer_node-3] use_trajectory_builder_3d = false, [cartographer_node-3] }, [cartographer_node-3] map_frame = "map", [cartographer_node-3] num_laser_scans = 1.000000, [cartographer_node-3] num_multi_echo_laser_scans = 0.000000, [cartographer_node-3] num_point_clouds = 0.000000, [cartographer_node-3] num_subdivisions_per_laser_scan = 1.000000, [cartographer_node-3] odom_frame = "odom", [cartographer_node-3] pose_publish_period_sec = 0.005000, [cartographer_node-3] provide_odom_frame = false, [cartographer_node-3] publish_frame_projected_to_2d = false, [cartographer_node-3] published_frame = "laser", [cartographer_node-3] submap_publish_period_sec = 0.300000, [cartographer_node-3] tracking_frame = "laser", [cartographer_node-3] trajectory_builder = { [cartographer_node-3] collate_fixed_frame = true, [cartographer_node-3] collate_landmarks = false, [cartographer_node-3] trajectory_builder_2d = { [cartographer_node-3] adaptive_voxel_filter = { [cartographer_node-3] max_length = 0.500000, [cartographer_node-3] max_range = 50.000000, [cartographer_node-3] min_num_points = 200.000000, [cartographer_node-3] }, [cartographer_node-3] ceres_scan_matcher = { [cartographer_node-3] ceres_solver_options = { [cartographer_node-3] max_num_iterations = 20.000000, [cartographer_node-3] num_threads = 1.000000, [cartographer_node-3] use_nonmonotonic_steps = false, [cartographer_node-3] }, [cartographer_node-3] occupied_space_weight = 1.000000, [cartographer_node-3] rotation_weight = 40.000000, [cartographer_node-3] translation_weight = 10.000000, [cartographer_node-3] }, [cartographer_node-3] imu_gravity_time_constant = 10.000000, [cartographer_node-3] loop_closure_adaptive_voxel_filter = { [cartographer_node-3] max_length = 0.900000, [cartographer_node-3] max_range = 50.000000, [cartographer_node-3] min_num_points = 100.000000, [cartographer_node-3] }, [cartographer_node-3] max_range = 12.000000, [cartographer_node-3] max_z = 2.000000, [cartographer_node-3] min_range = 0.100000, [cartographer_node-3] min_z = -0.800000, [cartographer_node-3] missing_data_ray_length = 5.000000, [cartographer_node-3] motion_filter = { [cartographer_node-3] max_angle_radians = 0.017453, [cartographer_node-3] max_distance_meters = 0.200000, [cartographer_node-3] max_time_seconds = 5.000000, [cartographer_node-3] }, [cartographer_node-3] num_accumulated_range_data = 1.000000, [cartographer_node-3] pose_extrapolator = { [cartographer_node-3] constant_velocity = { [cartographer_node-3] imu_gravity_time_constant = 10.000000, [cartographer_node-3] pose_queue_duration = 0.001000, [cartographer_node-3] }, [cartographer_node-3] imu_based = { [cartographer_node-3] gravity_constant = 9.806000, [cartographer_node-3] imu_acceleration_weight = 1.000000, [cartographer_node-3] imu_rotation_weight = 1.000000, [cartographer_node-3] odometry_rotation_weight = 1.000000, [cartographer_node-3] odometry_translation_weight = 1.000000, [cartographer_node-3] pose_queue_duration = 5.000000, [cartographer_node-3] pose_rotation_weight = 1.000000, [cartographer_node-3] pose_translation_weight = 1.000000, [cartographer_node-3] solver_options = { [cartographer_node-3] max_num_iterations = 10.000000, [cartographer_node-3] num_threads = 1.000000, [cartographer_node-3] use_nonmonotonic_steps = false, [cartographer_node-3] }, [cartographer_node-3] }, [cartographer_node-3] use_imu_based = false, [cartographer_node-3] }, [cartographer_node-3] real_time_correlative_scan_matcher = { [cartographer_node-3] angular_search_window = 0.349066, [cartographer_node-3] linear_search_window = 0.100000, [cartographer_node-3] rotation_delta_cost_weight = 0.100000, [cartographer_node-3] translation_delta_cost_weight = 10.000000, [cartographer_node-3] }, [cartographer_node-3] submaps = { [cartographer_node-3] grid_options_2d = { [cartographer_node-3] grid_type = "PROBABILITY_GRID", [cartographer_node-3] resolution = 0.050000, [cartographer_node-3] }, [cartographer_node-3] num_range_data = 35.000000, [cartographer_node-3] range_data_inserter = { [cartographer_node-3] probability_grid_range_data_inserter = { [cartographer_node-3] hit_probability = 0.550000, [cartographer_node-3] insert_free_space = true, [cartographer_node-3] miss_probability = 0.490000, [cartographer_node-3] }, [cartographer_node-3] range_data_inserter_type = "PROBABILITY_GRID_INSERTER_2D", [cartographer_node-3] tsdf_range_data_inserter = { [cartographer_node-3] maximum_weight = 10.000000, [cartographer_node-3] normal_estimation_options = { [cartographer_node-3] num_normal_samples = 4.000000, [cartographer_node-3] sample_radius = 0.500000, [cartographer_node-3] }, [cartographer_node-3] project_sdf_distance_to_scan_normal = true, [cartographer_node-3] truncation_distance = 0.300000, [cartographer_node-3] update_free_space = false, [cartographer_node-3] update_weight_angle_scan_normal_to_ray_kernel_bandwidth = 0.500000, [cartographer_node-3] update_weight_distance_cell_to_hit_kernel_bandwidth = 0.500000, [cartographer_node-3] update_weight_range_exponent = 0.000000, [cartographer_node-3] }, [cartographer_node-3] }, [cartographer_node-3] }, [cartographer_node-3] use_imu_data = false, [cartographer_node-3] use_online_correlative_scan_matching = true, [cartographer_node-3] voxel_filter_size = 0.025000, [cartographer_node-3] }, [cartographer_node-3] trajectory_builder_3d = { [cartographer_node-3] ceres_scan_matcher = { [cartographer_node-3] ceres_solver_options = { [cartographer_node-3] max_num_iterations = 12.000000, [cartographer_node-3] num_threads = 1.000000, [cartographer_node-3] use_nonmonotonic_steps = false, [cartographer_node-3] }, [cartographer_node-3] intensity_cost_function_options_0 = { [cartographer_node-3] huber_scale = 0.300000, [cartographer_node-3] intensity_threshold = 40.000000, [cartographer_node-3] weight = 0.500000, [cartographer_node-3] }, [cartographer_node-3] occupied_space_weight_0 = 1.000000, [cartographer_node-3] occupied_space_weight_1 = 6.000000, [cartographer_node-3] only_optimize_yaw = false, [cartographer_node-3] rotation_weight = 400.000000, [cartographer_node-3] translation_weight = 5.000000, [cartographer_node-3] }, [cartographer_node-3] high_resolution_adaptive_voxel_filter = { [cartographer_node-3] max_length = 2.000000, [cartographer_node-3] max_range = 15.000000, [cartographer_node-3] min_num_points = 150.000000, [cartographer_node-3] }, [cartographer_node-3] imu_gravity_time_constant = 10.000000, [cartographer_node-3] low_resolution_adaptive_voxel_filter = { [cartographer_node-3] max_length = 4.000000, [cartographer_node-3] max_range = 60.000000, [cartographer_node-3] min_num_points = 200.000000, [cartographer_node-3] }, [cartographer_node-3] max_range = 60.000000, [cartographer_node-3] min_range = 1.000000, [cartographer_node-3] motion_filter = { [cartographer_node-3] max_angle_radians = 0.004000, [cartographer_node-3] max_distance_meters = 0.100000, [cartographer_node-3] max_time_seconds = 0.500000, [cartographer_node-3] }, [cartographer_node-3] num_accumulated_range_data = 1.000000, [cartographer_node-3] pose_extrapolator = { [cartographer_node-3] constant_velocity = { [cartographer_node-3] imu_gravity_time_constant = 10.000000, [cartographer_node-3] pose_queue_duration = 0.001000, [cartographer_node-3] }, [cartographer_node-3] imu_based = { [cartographer_node-3] gravity_constant = 9.806000, [cartographer_node-3] imu_acceleration_weight = 1.000000, [cartographer_node-3] imu_rotation_weight = 1.000000, [cartographer_node-3] odometry_rotation_weight = 1.000000, [cartographer_node-3] odometry_translation_weight = 1.000000, [cartographer_node-3] pose_queue_duration = 5.000000, [cartographer_node-3] pose_rotation_weight = 1.000000, [cartographer_node-3] pose_translation_weight = 1.000000, [cartographer_node-3] solver_options = { [cartographer_node-3] max_num_iterations = 10.000000, [cartographer_node-3] num_threads = 1.000000, [cartographer_node-3] use_nonmonotonic_steps = false, [cartographer_node-3] }, [cartographer_node-3] }, [cartographer_node-3] use_imu_based = false, [cartographer_node-3] }, [cartographer_node-3] real_time_correlative_scan_matcher = { [cartographer_node-3] angular_search_window = 0.017453, [cartographer_node-3] linear_search_window = 0.150000, [cartographer_node-3] rotation_delta_cost_weight = 0.100000, [cartographer_node-3] translation_delta_cost_weight = 0.100000, [cartographer_node-3] }, [cartographer_node-3] rotational_histogram_size = 120.000000, [cartographer_node-3] submaps = { [cartographer_node-3] high_resolution = 0.100000, [cartographer_node-3] high_resolution_max_range = 20.000000, [cartographer_node-3] low_resolution = 0.450000, [cartographer_node-3] num_range_data = 160.000000, [cartographer_node-3] range_data_inserter = { [cartographer_node-3] hit_probability = 0.550000, [cartographer_node-3] intensity_threshold = 40.000000, [cartographer_node-3] miss_probability = 0.490000, [cartographer_node-3] num_free_space_voxels = 2.000000, [cartographer_node-3] }, [cartographer_node-3] }, [cartographer_node-3] use_intensities = false, [cartographer_node-3] use_online_correlative_scan_matching = false, [cartographer_node-3] voxel_filter_size = 0.150000, [cartographer_node-3] }, [cartographer_node-3] }, [cartographer_node-3] trajectory_publish_period_sec = 0.030000, [cartographer_node-3] use_landmarks = false, [cartographer_node-3] use_nav_sat = false, [cartographer_node-3] use_odometry = false, [cartographer_node-3] use_pose_extrapolator = false, [cartographer_node-3] } [cartographer_node-3] *** Check failure stack trace: *** [cartographer_node-3] @ 0x70013805eb03 google::LogMessage::Fail() [cartographer_node-3] @ 0x7001380669d1 google::LogMessage::SendToLog() [cartographer_node-3] @ 0x70013805e7c2 google::LogMessage::Flush() [cartographer_node-3] @ 0x70013806078f google::LogMessageFatal::~LogMessageFatal() [cartographer_node-3] @ 0x6244d3d20ce7 (unknown) [cartographer_node-3] @ 0x6244d3d20d66 (unknown) [cartographer_node-3] @ 0x6244d3d20ff3 (unknown) [cartographer_node-3] @ 0x6244d3d071d4 (unknown) [cartographer_node-3] @ 0x6244d3c6d7b3 (unknown) [cartographer_node-3] @ 0x700137029d90 (unknown) [cartographer_node-3] @ 0x700137029e40 __libc_start_main [cartographer_node-3] @ 0x6244d3c70d35 (unknown) [ERROR] [cartographer_node-3]: process has died [pid 19255, exit code -6, cmd '/opt/ros/humble/lib/cartographer_ros/cartographer_node -configuration_directory /home/michael/ros2_ws/install/ldlidar-ros2/share/ldlidar-ros2/configuration_files -configuration_basename mylaser.lua --ros-args --params-file /tmp/launch_params_5v_a720m -r scan:=scan'].
最新发布
11-14
评论 1
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值