点云配准代码

import open3d as o3d
import numpy as np
import copy
def draw_registration_result(source, target, transformation):
    """Visualize the registration result."""
    source_temp = copy.deepcopy(source)
    source_temp.transform(transformation)
    o3d.visualization.draw_geometries([source_temp, target])

# 1. 读取两个点云
source = o3d.io.read_point_cloud("peizhun/1697938934952.pcd")
target = o3d.io.read_point_cloud("peizhun/1697938935423.pcd")

# 2. 下采样点云 (可选)
source_down = source.voxel_down_sample(voxel_size=5)
target_down = target.voxel_down_sample(voxel_size=5)

# 3. 估计法线 (对于某些 ICP 变体可能需要)
# source_down.estimate_normals(search_param=o3d.geometry.KDTreeSearchParamHybrid(radius=100, max_nn=30))
# target_down.estimate_normals(search_param=o3d.geometry.KDTreeSearchParamHybrid(radius=100, max_nn=30))

# 4. 执行 ICP
init_guess = np.eye(4)  # 如果你有一个初步的变换猜测,可以替换这里
threshold = 50  # 两点之间的最大距离
reg_p2p = o3d.pipelines.registration.registration_icp(
    source_down, target_down, threshold, init_guess,
    o3d.pipelines.registration.TransformationEstimationPointToPoint())

# 5. 显示结果
print("Transformation is:")
print(reg_p2p.transformation)
draw_registration_result(source, target, reg_p2p.transformation)

  • 1、source_temp = copy.deepcopy(source)
  • 这行代码是用来创建source的深拷贝source_temp。深拷贝是指创建一个新的对象,将原对象的所有内容复制到新对象中,包括对象内部的所有引用对象。这样做是为了在对source_temp进行变换操作时不影响原始的source对象。

  • 2、source_temp.transform(transformation)
  • 这行代码是将source_temp点云对象应用变换矩阵transformation。transform函数会将点云对象的所有点坐标按照给定的变换矩阵进行变换。在这里,source_temp点云对象会根据transformation进行平移、旋转、缩放等变换操作。这样做是为了将source_temp点云对象与target点云对象对齐,以便进行配准结果的可视化。

  • 3、TransformationEstimationPointToPoint函数

  • TransformationEstimationPointToPoint是Open3D中的一个类,用于估计点对点的变换矩阵。它是ICP算法中的一种常用的变换估计方法。

    在ICP算法中,变换估计的目标是找到一个变换矩阵,将源点云中的点与目标点云中的对应点对齐。TransformationEstimationPointToPoint通过最小化点对之间的距离来估计变换矩阵。

    具体来说,TransformationEstimationPointToPoint的估计过程如下:

    1. 对于每个源点云中的点,找到其在目标点云中的最近邻点。

    2. 根据找到的点对,计算源点云中的点与目标点云中的对应点之间的距离。

    3. 使用最小二乘法或其他优化方法,找到最优的变换矩阵,使得点对之间的距离最小化。

    4. 返回估计得到的变换矩阵。

    TransformationEstimationPointToPoint是Open3D中的一个默认变换估计方法,适用于大多数点云配准场景。但在某些特殊情况下,可能需要使用其他的变换估计方法,如TransformationEstimationPointToPlane,它考虑了点云表面的法线信息,可以更好地处理非刚性变换的情况。

    总之,TransformationEstimationPointToPoint是一个用于估计点对点变换矩阵的类,它在ICP算法中起到了关键的作用,帮助实现点云的配准。

  • 4、o3d.pipelines.registration.registration_icp()函数
  • o3d.pipelines.registration.registration_icp()是Open3D中用于执行ICP(Iterative Closest Point)算法的函数。它用于将两个点云对象进行配准,以获得它们之间的最佳变换矩阵。

    函数的参数如下:

    • source:源点云对象,即待配准的点云。

    • target:目标点云对象,即参考点云。

    • threshold:两点之间的最大距离阈值。超过该阈值的点对将被忽略。

    • init:初始变换矩阵的猜测。默认为None,表示使用单位矩阵作为初始猜测。

    • estimation_method:变换估计方法。默认为o3d.pipelines.registration.TransformationEstimationPointToPoint(),表示使用点对点的最小二乘法来估计变换矩阵。

    • criteria:迭代终止准则。默认为o3d.pipelines.registration.ICPConvergenceCriteria(),表示使用默认的收敛准则。

    函数返回一个RegistrationResult对象,包含了配准的结果信息,如变换矩阵、配准误差等。

    ICP算法的基本思想是通过迭代的方式,不断优化变换矩阵,使得源点云与目标点云之间的距离最小化。具体的步骤如下:

    1. 对源点云进行下采样(可选)。

    2. 根据初始变换矩阵的猜测,将源点云进行变换。

    3. 在变换后的源点云和目标点云之间建立对应关系。

    4. 根据对应关系,计算点对之间的距离。

    5. 根据距离信息,使用变换估计方法估计新的变换矩阵。

    6. 更新变换矩阵,并判断是否满足终止准则。

    7. 如果未满足终止准则,则返回第3步,继续迭代;否则,返回最终的变换矩阵和配准误差。

    通过调用o3d.pipelines.registration.registration_icp()函数,可以方便地进行点云配准操作,并获得配准结果。

  • 5、o3d.pipelines.registration.evaluate_registration(source, target, threshold, trans_init)函数
  • o3d.pipelines.registration.evaluate_registration()是Open3D中用于评估点云配准结果的函数。它计算了两个重要的指标:fitness和inlier_rmse。

    函数的参数如下:

    • source:源点云对象,即待配准的点云。

    • target:目标点云对象,即参考点云。

    • threshold:距离阈值,用于筛选配准后的内点对应关系。

    • trans_init:初始变换矩阵,一般由粗配准提供。

    函数返回一个RegistrationResult对象,包含了配准结果的评估信息。

    具体来说,evaluate_registration()函数的计算过程如下:

    1. 根据初始变换矩阵,将源点云进行变换。

    2. 在变换后的源点云和目标点云之间建立对应关系。

    3. 根据对应关系,计算点对之间的距离。

    4. 根据距离信息和阈值,筛选出内点对应关系。

    5. 根据内点对应关系,计算fitness和inlier_rmse。

    6. 返回配准结果的评估信息。

    fitness指标计算了重叠区域内的内点对应关系的比例,即内点对应关系数目除以目标点云的点数。fitness越高,表示重叠区域越大,配准效果越好。

    inlier_rmse指标计算了所有内点对应关系的均方根误差(RMSE)。inlier_rmse越低,表示内点对应关系的匹配误差越小,配准效果越好。

    通过调用evaluate_registration()函数,可以获得点云配准结果的评估信息,帮助判断配准的质量和准确性。

6、cv2.blur(img, kernel_size)均值滤波

import cv2

# 读取图像
img = cv2.imread('image.jpg')

# 进行均值滤波
kernel_size = (5, 5)  # 滤波器大小
filtered_img = cv2.blur(img, kernel_size)

# 显示原始图像和滤波后的图像
cv2.imshow('Original Image', img)
cv2.imshow('Filtered Image', filtered_img)
cv2.waitKey(0)
cv2.destroyAllWindows()

7、中值滤波filtered_img = cv2.medianBlur(img, 5)解释5的含义

  • 在代码filtered_img = cv2.medianBlur(img, 5)中,参数5表示中值滤波的卷积核大小。中值滤波是一种非线性滤波方法,它使用像素周围邻域的中值来替代当前像素的值,从而去除图像中的噪声。

    卷积核的大小决定了中值滤波的邻域大小。在这里,卷积核的大小为5x5,表示使用一个5x5的邻域来计算每个像素的中值。具体来说,对于每个像素,将其周围5x5邻域内的像素值排序,然后取中间值作为该像素的新值。

    通过调整卷积核的大小,可以控制中值滤波的效果。较小的卷积核可以更好地去除细小的噪声,但可能会损失图像的细节;而较大的卷积核可以更好地去除较大的噪声,但可能会导致图像模糊。

    因此,在使用中值滤波时,需要根据具体的图像和噪声情况选择合适的卷积核大小,以获得满意的去噪效果。

8、高斯核的标准差是怎么用的

  • 高斯核的标准差是用来控制高斯滤波器的形状的参数。标准差越大,高斯核越平坦,权重下降得越慢;标准差越小,高斯核越尖锐,权重下降得越快。

    在高斯滤波中,标准差的值决定了高斯核的形状。具体来说,标准差越大,高斯核的权重分布越平均,滤波器对图像的平滑效果越明显;标准差越小,高斯核的权重分布越集中,滤波器对图像的平滑效果越细致。

    在代码中,我们可以通过调整标准差的值来控制高斯滤波的效果。如果将标准差设置为0,cv2.GaussianBlur()函数会根据高斯核的大小自动计算标准差,以确保高斯滤波器的形状与高斯核的大小相匹配。

    总之,标准差是用来调整高斯滤波器的形状的参数,通过改变标准差的值,我们可以控制高斯滤波的平滑程度和细节保留程度。

  • 9、双边滤波(Bilateral Filtering):

  • 复制import cv2
    
    # 读取图像
    img = cv2.imread('image.jpg')
    
    # 双边滤波
    filtered_img = cv2.bilateralFilter(img, 9, 75, 75)
    
    # 显示原始图像和滤波后的图像
    cv2.imshow('Original Image', img)
    cv2.imshow('Filtered Image', filtered_img)
    cv2.waitKey(0)
    cv2.destroyAllWindows()

 10、直方图均衡化(Histogram Equalization): 直方图均衡化是一种通过调整图像的像素值分布来增强图像对比度的方法。

import cv2

# 读取图像
img = cv2.imread('image.jpg', 0)

# 进行直方图均衡化
img_eq = cv2.equalizeHist(img)

# 显示原始图像和均衡化后的图像
cv2.imshow('Original Image', img)
cv2.imshow('Equalized Image', img_eq)
cv2.waitKey(0)
cv2.destroyAllWindows()

11、锐化

kernel = np.array([[-1, -1, -1], [-1, 9, -1], [-1, -1, -1]]) # 进行锐化 img_sharpened = cv2.filter2D(img, -1, kernel)

12、对比度增强

alpha = 1.5 # 对比度增强因子 enhanced_img = np.clip(alpha * img, 0, 255).astype(np.uint8)

13、颜色增强

# 颜色增强 beta = 1.2 # 颜色增强因子 enhanced_img = np.clip(beta * img, 0, 255).astype(np.uint8)

  • 18
    点赞
  • 21
    收藏
    觉得还不错? 一键收藏
  • 1
    评论

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论 1
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值