hofee/nbv_reconstruction
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

update strategy and overlap rate compute method

Browse Source
This commit is contained in:
hofee
2024-08-30 16:49:21 +08:00
parent a14bdc2c55
commit 71676e2f4e
9 changed files with 123 additions and 149 deletions
Download Patch File Download Diff File Expand all files Collapse all files

74
utils/reconstruction.py
View File

@@ -1,6 +1,6 @@
import numpy as np
import open3d as o3d
from scipy.spatial import cKDTree
from utils.pts import PtsUtil
class ReconstructionUtil:
@@ -13,18 +13,12 @@ class ReconstructionUtil:
return coverage_rate
@staticmethod
def compute_overlap_rate(point_cloud1, point_cloud2, threshold=0.01):
kdtree1 = cKDTree(point_cloud1)
kdtree2 = cKDTree(point_cloud2)
distances1, _ = kdtree2.query(point_cloud1)
distances2, _ = kdtree1.query(point_cloud2)
overlapping_points1 = np.sum(distances1 < threshold)
overlapping_points2 = np.sum(distances2 < threshold)
overlap_rate1 = overlapping_points1 / point_cloud1.shape[0]
overlap_rate2 = overlapping_points2 / point_cloud2.shape[0]
return (overlap_rate1 + overlap_rate2) / 2
def compute_overlap_rate(new_point_cloud, combined_point_cloud, threshold=0.01):
kdtree = cKDTree(combined_point_cloud)
distances, _ = kdtree.query(new_point_cloud)
overlapping_points = np.sum(distances < threshold)
overlap_rate = overlapping_points / new_point_cloud.shape[0]
return overlap_rate
@staticmethod
def combine_point_with_view_sequence(point_list, view_sequence):
@@ -41,46 +35,14 @@ class ReconstructionUtil:
for view_index, view in enumerate(views):
candidate_views = combined_point_cloud + [view]
down_sampled_combined_point_cloud = ReconstructionUtil.downsample_point_cloud(candidate_views, threshold)
down_sampled_combined_point_cloud = PtsUtil.voxel_downsample_point_cloud(candidate_views, threshold)
new_coverage = ReconstructionUtil.compute_coverage_rate(target_point_cloud, down_sampled_combined_point_cloud, threshold)
coverage_increase = new_coverage - current_coverage
if coverage_increase > best_coverage_increase:
best_coverage_increase = coverage_increase
best_view = view_index
return best_view, best_coverage_increase
@staticmethod
def compute_next_best_view_sequence(target_point_cloud, point_cloud_list, threshold=0.01):
selected_views = []
current_coverage = 0.0
remaining_views = list(range(len(point_cloud_list)))
view_sequence = []
target_point_cloud = ReconstructionUtil.downsample_point_cloud(target_point_cloud, threshold)
while remaining_views:
best_view = None
best_coverage_increase = -1
for view_index in remaining_views:
candidate_views = selected_views + [point_cloud_list[view_index]]
combined_point_cloud = np.vstack(candidate_views)
down_sampled_combined_point_cloud = ReconstructionUtil.downsample_point_cloud(combined_point_cloud,threshold)
new_coverage = ReconstructionUtil.compute_coverage_rate(target_point_cloud, down_sampled_combined_point_cloud, threshold)
coverage_increase = new_coverage - current_coverage
if coverage_increase > best_coverage_increase:
best_coverage_increase = coverage_increase
best_view = view_index
if best_view is not None:
if best_coverage_increase <=1e-3:
break
selected_views.append(point_cloud_list[best_view])
current_coverage += best_coverage_increase
view_sequence.append((best_view, current_coverage))
remaining_views.remove(best_view)
return view_sequence, remaining_views
@staticmethod
def compute_next_best_view_sequence_with_overlap(target_point_cloud, point_cloud_list, threshold=0.01, overlap_threshold=0.3):
@@ -88,7 +50,6 @@ class ReconstructionUtil:
current_coverage = 0.0
remaining_views = list(range(len(point_cloud_list)))
view_sequence = []
target_point_cloud = ReconstructionUtil.downsample_point_cloud(target_point_cloud, threshold)
while remaining_views:
best_view = None
@@ -98,15 +59,15 @@ class ReconstructionUtil:
if selected_views:
combined_old_point_cloud = np.vstack(selected_views)
down_sampled_old_point_cloud = ReconstructionUtil.downsample_point_cloud(combined_old_point_cloud,threshold)
down_sampled_new_view_point_cloud = ReconstructionUtil.downsample_point_cloud(point_cloud_list[view_index],threshold)
overlap_rate = ReconstructionUtil.compute_overlap_rate(down_sampled_old_point_cloud,down_sampled_new_view_point_cloud , threshold)
down_sampled_old_point_cloud = PtsUtil.voxel_downsample_point_cloud(combined_old_point_cloud,threshold)
down_sampled_new_view_point_cloud = PtsUtil.voxel_downsample_point_cloud(point_cloud_list[view_index],threshold)
overlap_rate = ReconstructionUtil.compute_overlap_rate(down_sampled_new_view_point_cloud,down_sampled_old_point_cloud, threshold)
if overlap_rate < overlap_threshold:
continue
candidate_views = selected_views + [point_cloud_list[view_index]]
combined_point_cloud = np.vstack(candidate_views)
down_sampled_combined_point_cloud = ReconstructionUtil.downsample_point_cloud(combined_point_cloud,threshold)
down_sampled_combined_point_cloud = PtsUtil.voxel_downsample_point_cloud(combined_point_cloud,threshold)
new_coverage = ReconstructionUtil.compute_coverage_rate(target_point_cloud, down_sampled_combined_point_cloud, threshold)
coverage_increase = new_coverage - current_coverage
#print(f"view_index: {view_index}, coverage_increase: {coverage_increase}")
@@ -128,12 +89,5 @@ class ReconstructionUtil:
break
return view_sequence, remaining_views
def downsample_point_cloud(point_cloud, voxel_size=0.005):
o3d_pc = o3d.geometry.PointCloud()
o3d_pc.points = o3d.utility.Vector3dVector(point_cloud)
downsampled_pc = o3d_pc.voxel_down_sample(voxel_size)
return np.asarray(downsampled_pc.points)