如何在PCL的ICP与GICP算法中设置点云重叠率？

我来帮你解决这个问题——之前我也踩过类似的坑，直接把CorrespondenceRejectorTrimmed扔给GICP往往没效果，核心是要正确把它接入GICP的对应关系处理流程里。下面是完整的实现步骤和代码示例：

核心思路 #

CorrespondenceRejectorTrimmed的作用是保留误差最小的前N%（或固定数量）的对应关系，这个比例就是你要设置的点云重叠率。GICP继承自PCL的Registration基类，我们需要把这个拒绝器添加到它的对应关系过滤链中，让GICP在计算初始对应后自动用它修剪无效匹配。

完整代码实现 #

#include <pcl/io/pcd_io.h>
#include <pcl/point_types.h>
#include <pcl/registration/gicp.h>
#include <pcl/registration/correspondence_rejection_trimmed.h>

int main(int argc, char** argv) {
    // 1. 加载源点云和目标点云（请替换成你的点云路径）
    pcl::PointCloud<pcl::PointXYZ>::Ptr source(new pcl::PointCloud<pcl::PointXYZ>);
    pcl::PointCloud<pcl::PointXYZ>::Ptr target(new pcl::PointCloud<pcl::PointXYZ>);
    if (pcl::io::loadPCDFile<pcl::PointXYZ>("source.pcd", *source) == -1 ||
        pcl::io::loadPCDFile<pcl::PointXYZ>("target.pcd", *target) == -1) {
        PCL_ERROR("无法加载点云文件！\n");
        return -1;
    }

    // 2. 初始化GICP配准器
    pcl::GeneralizedIterativeClosestPoint<pcl::PointXYZ, pcl::PointXYZ> gicp;
    gicp.setInputSource(source);
    gicp.setInputTarget(target);

    // 3. 创建并配置CorrespondenceRejectorTrimmed
    pcl::registration::CorrespondenceRejectorTrimmed::Ptr trimmed_rejector(
        new pcl::registration::CorrespondenceRejectorTrimmed);
    
    // 设置重叠率对应的保留比例：比如希望保留60%的有效对应（重叠率60%），就设为0.6
    // 注意：这个值是保留的比例，不是丢弃的比例！
    trimmed_rejector->setTrimFraction(0.6);

    // 可选：如果知道精确的重叠点数量，可以用绝对数量替代比例
    // trimmed_rejector->setKeepAbsolute(true);
    // trimmed_rejector->setNumberOfCorrespondences(1500); // 固定保留1500个最优对应

    // 4. 把拒绝器添加到GICP的对应处理链中（关键步骤！）
    gicp.addCorrespondenceRejector(trimmed_rejector);

    // 5. 配置GICP的其他参数（按需调整）
    gicp.setMaximumIterations(50);
    gicp.setTransformationEpsilon(1e-8); // 变换矩阵的收敛阈值
    gicp.setEuclideanFitnessEpsilon(1e-6); // 拟合误差的收敛阈值

    // 6. 执行配准
    pcl::PointCloud<pcl::PointXYZ>::Ptr aligned(new pcl::PointCloud<pcl::PointXYZ>);
    gicp.align(*aligned);

    // 7. 输出配准结果
    if (gicp.hasConverged()) {
        std::cout << "配准成功！最终变换矩阵:\n" << gicp.getFinalTransformation() << std::endl;
        std::cout << "拟合误差: " << gicp.getFitnessScore() << std::endl;
    } else {
        std::cerr << "配准未收敛，请检查点云或参数设置！\n";
    }

    return 0;
}

常见问题排查 #

你之前可能失败的原因大概率是以下几点：

• 没有正确添加拒绝器：直接创建拒绝器但没调用addCorrespondenceRejector把它加入GICP的处理链，导致GICP根本没用到它。
• 参数搞反了：setTrimFraction设置的是保留的对应比例，不是丢弃的比例。比如重叠率60%要设0.6，不是0.4。
• 顺序问题：如果同时使用多个对应拒绝器（比如距离过滤），要注意添加顺序——建议先加CorrespondenceRejectorTrimmed，再加其他过滤规则，或者根据你的需求调整。

额外提示 #

• 点云预处理（下采样、滤波）很重要：如果点云噪声大或者密度不均，先做预处理能让CorrespondenceRejectorTrimmed更准确地筛选有效对应。
• 调试时可以输出对应关系数量：用gicp.getCorrespondences()查看过滤前后的对应数，验证是否符合你的预期。

内容的提问来源于stack exchange，提问作者meakcey