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
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
use cgmath::{InnerSpace, Vector3};
use std::collections::{HashMap, HashSet};
use poly::{EmitLines, Line, Triangle};
use Normal;
pub struct Neighbors<T> {
pub vertices: Vec<T>,
pub polygons: Vec<Triangle<usize>>,
shares_edge: HashMap<Line<usize>, Vec<usize>>,
shares_vertex: HashMap<usize, Vec<usize>>,
}
impl<T> Neighbors<T> {
pub fn new(vertices: Vec<T>, polygons: Vec<Triangle<usize>>) -> Self {
let mut shares_edge = HashMap::new();
let mut shares_vertex = HashMap::new();
for (i, p) in polygons.iter().enumerate() {
p.clone().emit_lines(|line| {
shares_vertex
.entry(line.x.clone())
.or_insert(Vec::new())
.push(i);
shares_vertex
.entry(line.y.clone())
.or_insert(Vec::new())
.push(i);
shares_edge.entry(line).or_insert(Vec::new()).push(i);
});
}
Neighbors {
vertices: vertices,
shares_vertex: shares_vertex,
shares_edge: shares_edge,
polygons: polygons,
}
}
pub fn split(self) -> (Vec<T>, Vec<Triangle<usize>>) {
(self.vertices, self.polygons)
}
pub fn vertex_neighbors(&self, t: &usize) -> Option<&[usize]> {
self.shares_vertex.get(t).map(|x| &x[..])
}
pub fn polygon_neighbors(&self, i: usize) -> Option<HashSet<usize>> {
self.polygons.get(i).map(|x| {
let mut v = HashSet::new();
x.clone().emit_lines(|line| {
self.shares_edge.get(&line).map(|x| {
for &i in x {
v.insert(i);
}
});
});
v.remove(&i);
v
})
}
pub fn normal_for_face<F>(&self, i: usize, mut f: F) -> Normal
where
F: FnMut(&T) -> Normal,
{
let Triangle { x, y, z } = self.polygons[i];
let x = Vector3::from(f(&self.vertices[x]));
let y = Vector3::from(f(&self.vertices[y]));
let z = Vector3::from(f(&self.vertices[z]));
let a = z - x;
let b = z - y;
a.cross(b).normalize().into()
}
pub fn normal_for_vertex<F>(&self, i: usize, mut f: F) -> Normal
where
F: FnMut(&T) -> Normal,
{
let mut normal = Vector3::new(0f32, 0., 0.);
for &face in &self.shares_vertex[&i] {
normal += Vector3::from(self.normal_for_face(face, &mut f));
}
normal.normalize().into()
}
}