-
Notifications
You must be signed in to change notification settings - Fork 1.2k
/
meshing_utilities.cc
44 lines (37 loc) · 1.25 KB
/
meshing_utilities.cc
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
#include "drake/geometry/proximity/meshing_utilities.h"
#include <unordered_set>
namespace drake {
namespace geometry {
namespace internal {
void Append(const std::vector<VolumeElement>& new_elements,
std::vector<VolumeElement>* mesh_elements) {
mesh_elements->insert(mesh_elements->end(), new_elements.begin(),
new_elements.end());
}
using std::unordered_set;
std::vector<VolumeElement> SplitTriangularPrismToTetrahedra(int v0, int v1,
int v2, int v3,
int v4, int v5) {
std::vector<VolumeElement> elements;
elements.reserve(3);
int previous = v3;
for (int next : {v4, v1, v2}) {
elements.emplace_back(previous, next, v0, v5);
previous = next;
}
return elements;
}
std::vector<VolumeElement> SplitPyramidToTetrahedra(int v0, int v1, int v2,
int v3, int v4) {
std::vector<VolumeElement> elements;
elements.reserve(2);
int previous = v3;
for (int next : {v4, v1}) {
elements.emplace_back(previous, next, v0, v2);
previous = next;
}
return elements;
}
} // namespace internal
} // namespace geometry
} // namespace drake