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
|
#include "GLUtils.hpp"
namespace yade { // Cannot have #include directive inside.
void GLUtils::Parallelepiped(const Vector3r& a, const Vector3r& b, const Vector3r& c)
{
glBegin(GL_LINE_STRIP)
;
glVertex3v(b);
glVertex3v(Vector3r(Vector3r::Zero()));
glVertex3v(a);
glVertex3v(Vector3r(a + b));
glVertex3v(Vector3r(a + b + c));
glVertex3v(Vector3r(b + c));
glVertex3v(b);
glVertex3v(Vector3r(a + b));
glEnd();
glBegin(GL_LINE_STRIP)
;
glVertex3v(Vector3r(b + c));
glVertex3v(c);
glVertex3v(Vector3r(a + c));
glVertex3v(a);
glEnd();
glBegin(GL_LINES)
;
glVertex3v(Vector3r(Vector3r::Zero()));
glVertex3v(c);
glEnd();
glBegin(GL_LINES)
;
glVertex3v(Vector3r(a + c));
glVertex3v(Vector3r(a + b + c));
glEnd();
}
/****
code copied over from qglviewer
****/
/*! Draws a 3D arrow along the positive Z axis.
\p length, \p radius and \p nbSubdivisions define its geometry. If \p radius is negative
(default), it is set to 0.05 * \p length.
Use drawArrow(const Vec& from, const Vec& to, double radius, int nbSubdivisions) or change the \c
ModelView matrix to place the arrow in 3D.
Uses current color and does not modify the OpenGL state. */
void GLUtils::QGLViewer::drawArrow(double length, double radius, int nbSubdivisions)
{
static GLUquadric* quadric = gluNewQuadric();
if (radius < 0.0) radius = 0.05 * length;
const double head = 2.5 * (radius / length) + 0.1;
const double coneRadiusCoef = 4.0 - 5.0 * head;
gluCylinder(quadric, radius, radius, length * (1.0 - head / coneRadiusCoef), nbSubdivisions, 1);
glTranslate(0.0, 0.0, length * (1.0 - head));
gluCylinder(quadric, coneRadiusCoef * radius, 0.0, head * length, nbSubdivisions, 1);
glTranslate(0.0, 0.0, -length * (1.0 - head));
}
/*! Draws a 3D arrow between the 3D point \p from and the 3D point \p to, both defined in the
current ModelView coordinates system.
See drawArrow(double length, double radius, int nbSubdivisions) for details. */
void GLUtils::QGLViewer::drawArrow(const Vector3r& from, const Vector3r& to, double radius, int nbSubdivisions)
{
glPushMatrix();
glTranslate(from[0], from[1], from[2]);
Quaternionr q(Quaternionr().setFromTwoVectors(Vector3r(0, 0, 1), to - from));
glMultMatrix(q.toRotationMatrix().data());
drawArrow(static_cast<double>((to - from).norm()), radius, nbSubdivisions);
glPopMatrix();
}
} // namespace yade
|
