1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
use crate::math::Point;
use na::{Point3, RealField};
use std::iter;
pub fn remove_unused_points<N: RealField>(points: &mut Vec<Point<N>>, idx: &mut [Point3<u32>]) {
let mut used: Vec<bool> = iter::repeat(false).take(points.len()).collect();
let mut remap: Vec<usize> = (0..points.len()).map(|i| i).collect();
let used = &mut used[..];
let remap = &mut remap[..];
for i in idx.iter() {
used[i.x as usize] = true;
used[i.y as usize] = true;
used[i.z as usize] = true;
}
let mut i = 0;
while i != points.len() {
if !used[i] {
let _ = points.swap_remove(i);
remap[points.len()] = i;
used[i] = used[points.len()];
} else {
i = i + 1;
}
}
for id in idx.iter_mut() {
id.x = remap[id.x as usize] as u32;
id.y = remap[id.y as usize] as u32;
id.z = remap[id.z as usize] as u32;
}
}