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
|
/*************************************************************************
* Copyright (C) 2013 by Burak ER *
* *
* *
* This program is free software; it is licensed under the terms of the *
* GNU General Public License v2 or later. See file LICENSE for details. *
*************************************************************************/
#ifdef YADE_OPENGL
#ifdef YADE_FEM
#include <lib/opengl/OpenGLWrapper.hpp>
#include <pkg/fem/DeformableElement.hpp>
#include <pkg/fem/Gl1_DeformableElement.hpp>
namespace yade { // Cannot have #include directive inside.
typedef DeformableElement::NodeMap NodeMap;
void Gl1_DeformableElement::go(const shared_ptr<Shape>& cm, const shared_ptr<State>&, bool wire, const GLViewInfo&)
{
DeformableElement* element = static_cast<DeformableElement*>(cm.get());
std::vector<Vector3r> triangles = element->faces;
if (!(cm->wire || wire)) {
glDisable(GL_CULL_FACE);
//Vector3r normal=(facet->vertices[1]-facet->vertices[0]).cross(facet->vertices[2]-facet->vertices[1]); normal.normalize();
glColor3v(cm->color);
glBegin(GL_TRIANGLES)
;
FOREACH(Vector3r vertices, triangles)
{
NodeMap::iterator i1(element->localmap.begin());
NodeMap::iterator i2(i1);
NodeMap::iterator i3(i1);
NodeMap::iterator i4(i1);
//Find the opposite vertex total indice sum equals to six therefore the last one is going to be 6-sum of indices
// I accept it is very uncommon
int oppositevertexindex = 6 - int(math::round(vertices.sum())); /// XXX: this is suspicious
std::advance(i1, int(math::round(vertices[0])));
std::advance(i2, int(math::round(vertices[1])));
std::advance(i3, int(math::round(vertices[2])));
std::advance(i4, oppositevertexindex);
const shared_ptr<Body>& member1 = i1->first;
const shared_ptr<Body>& member2 = i2->first;
const shared_ptr<Body>& member3 = i3->first;
Vector3r& vertex0 = i1->first->state->pos;
Vector3r& vertex1 = i2->first->state->pos;
Vector3r& vertex2 = i3->first->state->pos;
Vector3r& vertex3 = i4->first->state->pos;
Vector3r normal = (vertex1 - vertex0).cross(vertex2 - vertex0);
normal.normalize();
if ((vertex3 - vertex0).dot(normal) > 0) normal = -normal;
glNormal3v(normal); // this makes every triangle different WRT the light
glVertex3v(member1->state->pos);
glVertex3v(member2->state->pos);
glVertex3v(member3->state->pos);
}
}
glEnd
();
glBegin(GL_LINE_LOOP)
;
glColor3v(Vector3r(0, 0, 0));
FOREACH(Vector3r vertices, triangles)
{
NodeMap::iterator i1(element->localmap.begin());
NodeMap::iterator i2(i1);
NodeMap::iterator i3(i1);
std::advance(i1, int(math::round(vertices[0])));
std::advance(i2, int(math::round(vertices[1])));
std::advance(i3, int(math::round(vertices[2])));
const shared_ptr<Body>& member1 = i1->first;
const shared_ptr<Body>& member2 = i2->first;
const shared_ptr<Body>& member3 = i3->first;
glVertex3v(member1->state->pos);
glVertex3v(member2->state->pos);
glVertex3v(member3->state->pos);
}
glEnd();
}
YADE_PLUGIN((Gl1_DeformableElement));
} // namespace yade
#endif //YADE_FEM
#endif /* YADE_OPENGL */
|
