-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathDivFunc.cpp
102 lines (86 loc) · 2.58 KB
/
DivFunc.cpp
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
Eigen::MatrixXd Vout = V;
Eigen::MatrixXi Fout = F;
// Add new node at triangle center
igl::adjacency_list(F, VV, true);
float divide = 0.3334;
Vout.conservativeResize((V.rows() + F.rows()), 3);
Fout.conservativeResize((F.rows() + F.rows() *2), 3);
for (int f = 0; f < F.rows(); ++f) {
auto v1i = F(f, 0); auto v1 = V.row(v1i);
auto v2i = F(f, 1); auto v2 = V.row(v2i);
auto v3i = F(f, 2); auto v3 = V.row(v3i);
int insertVIndex = V.rows()+ f;
Vout.row(insertVIndex) << divide * (v1(0) + v2(0) + v3(0)),
divide * (v1(1) + v2(1) + v3(1)),
divide * (v1(2) + v2(2) + v3(2));
Fout.row(f)<< v1i, v2i, insertVIndex;
Fout.row(F.rows() + 2* f) << v2i, v3i, insertVIndex;
Fout.row(F.rows() + 2* f+1) << v3i, v1i, insertVIndex;
}
// Move origin vertices
for (int i = 0; i < V.rows(); ++i) {
int n = VV[i].size();
auto a_n = (4 - 2 * cos(M_PI * 2 / n)) / 9;
Eigen::Vector3d sum = { 0, 0, 0 };
for (auto nb : VV[i]) {
sum += V.row(nb);
}
Eigen::Vector3d p =V.row(i);
auto newP = p* (1 - a_n) + a_n / n * sum;
Vout.row(i) << newP(0), newP(1), newP(2);
}
// Flip edge
igl::vertex_triangle_adjacency(Vout, Fout, VF, VFi);
for (int ov1 = 0; ov1 < V.rows(); ov1++) {
auto nb_ov1 = VV[ov1];
for (auto ov2 : nb_ov1) {
if (ov2 < ov1) {
continue;
}
// flip edge of ov1 to ov2
std::vector<int> nb_faces;
for (auto f : VF[ov1]) {
if (std::find(VF[ov2].begin(), VF[ov2].end(), f) != VF[ov2].end()) {
nb_faces.push_back(f);
}
}
//flip two face
if (nb_faces.size() != 2) {
cout << "error" << endl; continue;
}
std::vector<int> new_verts;
for (auto fi : nb_faces) {
auto f = Fout.row(fi);
for (int i = 0; i < 3; i++) {
if (f(i) != ov1&& f(i) != ov2) {
new_verts.push_back(f(i));
}
}
}
if (new_verts.size() != 2) {
cout << "error" << endl; continue;
}
int fi, vi;
Eigen::Vector3i f;
int usedOldNode =-1;
for (int i = 0; i < 2; i++) {
fi= nb_faces[i];
f = Fout.row(fi);
vi = new_verts[1-i];
for (int j = 0; j < 2; j++) {
if (f(j) >= V.rows() && f(j + 1) < V.rows() && f(j + 1) != usedOldNode) {
Fout.row(fi) << f(j), f(j + 1), vi;
usedOldNode = f(j + 1);
break;
}
else if (f(j + 1) >= V.rows() && f(j) < V.rows() && f(j) != usedOldNode) {
Fout.row(fi) << vi, f(j), f(j + 1);
usedOldNode = f(j);
break;
}
}
}
}
}
V = Vout; F = Fout;
update_display(viewer);