common:
useLoopClosure: false
pgo:
map_filter_size: 0.5 # the voxe size of the prior map
/** globalmap_filter_ptr is the filterd point cloud of the prior map
* if you want to be faster, just use this cloud, but there may need to adjust the icp score to get system initilization success
* */
// std::shared_ptr<geometry::PointCloud> target_o3d =
// cloud_process_.GetO3dPointCloudFromPCL(*globalmap_ptr);
std::shared_ptr<geometry::PointCloud> target_o3d cloud_process_.GetO3dPointCloudFromPCL(*globalmap_filter_ptr);
if you want to see the degeneracy performance, just set the scale
in rviz to a proper scale.
set parameter
pgo:
showDegenercy: true # show condition number or uncertainty in rviz
then you can see the sphere like us.