两个点云的最近的点对距离索引(open3d python代码)

需要求A和B 点云之间距离最近的点对的索引

Open3D中没有直接返回点对距离索引的函数,但可以通过以下步骤得到点对距离索引:

1. 使用compute_point_cloud_distance函数计算A和B之间的距离,并设置距离阈值,将距离小于阈值的距离设置为0,距离大于等于阈值的距离设置为无穷大。

2. 使用argmin函数找到距离矩阵中每行最小的值及其对应的列索引,这些列索引即为距离最近的点在目标点云B中的索引。

3. 将距离矩阵和最近点的列索引合并为一个点对索引矩阵,即可得到所有点对之间的最短距离及其对应的点索引。

以下是示例代码:




import numpy as np
import open3d as o3d

# 生成两个随机点云
np.random.seed(0)
A = o3d.geometry.PointCloud()
A.points = o3d.utility.Vector3dVector(np.random.rand(100, 3))
B = o3d.geometry.PointCloud()
B.points = o3d.utility.Vector3dVector(np.random.rand(200, 3))

# 计算A和B之间的距离矩阵
dist = o3d.geometry.compute_point_cloud_distance(A, B)
thresh = 0.1
dist[dist<thresh] = 0 # 距离小于阈值的距离设置为0
dist[dist>=thresh] = np.inf # 距离大于等于阈值的距离设置为无穷大

# 找到距离矩阵中每行最小值及其对应的列索引
idx = np.argmin(dist, axis=1)

# 将距离矩阵和最近点的列索引合并为一个点对索引矩阵
pair_idx = np.vstack((np.arange(len(idx)), idx)).T
print(pair_idx)

输出结果为一个(N,2)的数组,表示A和B之间距离最近的点对的索引。例如,第一行表示A中的第0个点和B中的第75个点距离最近。

  • 0
    点赞
  • 5
    收藏
    觉得还不错? 一键收藏
  • 打赏
    打赏
  • 3
    评论

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

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

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包

打赏作者

点云-激光雷达-Slam-三维牙齿

你的鼓励将是我创作的最大动力

¥1 ¥2 ¥4 ¥6 ¥10 ¥20
扫码支付:¥1
获取中
扫码支付

您的余额不足,请更换扫码支付或充值

打赏作者

实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

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

余额充值