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
use super::{sphere, utils};
use super::{IndexBuffer, TriMesh};
use alga::general::RealField;
use na;
pub fn capsule<N>(
caps_diameter: &N,
cylinder_height: &N,
ntheta_subdiv: u32,
nphi_subdiv: u32,
) -> TriMesh<N>
where
N: RealField,
{
let top = sphere::unit_hemisphere::<N>(ntheta_subdiv, nphi_subdiv);
let TriMesh {
coords,
normals,
indices,
..
} = top.clone();
let mut bottom_coords = coords;
let mut bottom_normals = normals.unwrap();
let mut bottom_indices = indices.unwrap_unified();
utils::reverse_clockwising(&mut bottom_indices[..]);
let TriMesh {
coords,
normals,
indices,
..
} = top;
let mut top_coords = coords;
let top_normals = normals.unwrap();
let mut top_indices = indices.unwrap_unified();
let half_height = *cylinder_height * na::convert(0.5);
for coord in top_coords.iter_mut() {
coord.x = coord.x * *caps_diameter;
coord.y = coord.y * *caps_diameter + half_height;
coord.z = coord.z * *caps_diameter;
}
for coord in bottom_coords.iter_mut() {
coord.x = coord.x * *caps_diameter;
coord.y = -(coord.y * *caps_diameter) - half_height;
coord.z = coord.z * *caps_diameter;
}
for normal in bottom_normals.iter_mut() {
normal.y = -normal.y;
}
let base_top_coords = bottom_coords.len() as u32;
for idx in top_indices.iter_mut() {
idx.x = idx.x + base_top_coords;
idx.y = idx.y + base_top_coords;
idx.z = idx.z + base_top_coords;
}
bottom_coords.extend(top_coords.into_iter());
bottom_normals.extend(top_normals.into_iter());
bottom_indices.extend(top_indices.into_iter());
utils::push_ring_indices(0, base_top_coords, ntheta_subdiv, &mut bottom_indices);
TriMesh::new(
bottom_coords,
Some(bottom_normals),
None,
Some(IndexBuffer::Unified(bottom_indices)),
)
}