C++ PCL 将一个点云投影到一个由法向量和点确定的平面

步骤实现:

复制代码
定义平面:使用法向量和平面上的一个点来定义平面方程。
计算投影矩阵:根据平面方程计算点到平面的投影矩阵。
应用投影矩阵:将点云中的每个点投影到平面上。

具体的实现示例:

css 复制代码
#include <pcl/io/pcd_io.h>
#include <pcl/point_types.h>
#include <pcl/common/common.h>
#include <pcl/common/transforms.h>
#include <pcl/common/eigen.h>

// 计算点到平面的投影矩阵
Eigen::Matrix4f computeProjectionMatrix(const Eigen::Vector3f& point, const Eigen::Vector3f& normal) {
    Eigen::Matrix4f projection_matrix = Eigen::Matrix4f::Identity();
    
    Eigen::Vector3f normalized_normal = normal.normalized();
    float d = -normalized_normal.dot(point);
    
    for (int i = 0; i < 3; ++i) {
        for (int j = 0; j < 3; ++j) {
            projection_matrix(i, j) -= normalized_normal[i] * normalized_normal[j];
        }
        projection_matrix(i, 3) = -normalized_normal[i] * d;
    }
    
    return projection_matrix;
}

int main(int argc, char** argv) {
    // 加载点云
    pcl::PointCloud<pcl::PointXYZ>::Ptr cloud(new pcl::PointCloud<pcl::PointXYZ>());
    if (pcl::io::loadPCDFile<pcl::PointXYZ>("input.pcd", *cloud) == -1) {
        PCL_ERROR("Couldn't read file input.pcd\n");
        return -1;
    }

    // 定义平面 (点和平面的法向量)
    Eigen::Vector3f point_on_plane(0.0, 0.0, 0.0);  // 平面上的一点
    Eigen::Vector3f plane_normal(0.0, 0.0, 1.0);   // 平面的法向量

    // 计算投影矩阵
    Eigen::Matrix4f projection_matrix = computeProjectionMatrix(point_on_plane, plane_normal);

    // 投影点云
    pcl::PointCloud<pcl::PointXYZ>::Ptr projected_cloud(new pcl::PointCloud<pcl::PointXYZ>());
    pcl::transformPointCloud(*cloud, *projected_cloud, projection_matrix);

    // 保存投影后的点云
    pcl::io::savePCDFileASCII("projected_cloud.pcd", *projected_cloud);

    return 0;
}
相关推荐
ytttr8736 分钟前
matlab通过Q学习算法解决房间路径规划问题
学习·算法·matlab
go54631584651 小时前
修改Spatial-MLLM项目,使其专注于无人机航拍视频的空间理解
人工智能·算法·机器学习·架构·音视频·无人机
油泼辣子多加1 小时前
【Torch】nn.BatchNorm1d算法详解
算法
nlog3n1 小时前
基于 govaluate 的监控系统中,如何设计灵活可扩展的自定义表达式函数体系
算法·go
IT古董2 小时前
【第三章:神经网络原理详解与Pytorch入门】01.神经网络算法理论详解与实践-(2)神经网络整体结构
pytorch·神经网络·算法
ThetaarSofVenice2 小时前
垃圾收集相关算法Test
java·jvm·算法
小陈phd2 小时前
langchain从入门到精通(二十八)——RAG优化策略(六)集成多种检索器算法实现混合检索及问题转换总结
算法
是小王同学啊~2 小时前
(LangChain)RAG系统链路向量检索器之Retrievers(五)
python·算法·langchain
薰衣草23332 小时前
一天两道力扣(1)
算法·leetcode·职场和发展
一粒沙白猫2 小时前
Java综合练习04
java·开发语言·算法