blob: 86e9f26a9febc8736f7562f98499395bef51aefe (
plain)
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
|
#include "hcoord.h"
#include <SDL/SDL_opengl.h>
#include <AR/ar.h>
HVector::HVector() {
w = 1.0;
}
HVector::HVector(double _x, double _y, double _z, double _w) {
x = _x;
y = _y;
z = _z;
w = _w;
}
HMatrix::HMatrix() {
m[3][0] = m[3][1] = m[3][2] = 0;
m[3][3] = 1.0;
}
HMatrix HMatrix::inverse() {
HMatrix res;
arUtilMatInv(m, res.m);
return res;
}
HVector HMatrix::operator*(const HVector& vec) {
HVector res;
res.x = m[0][0] * vec.x + m[0][1] * vec.y + m[0][2] * vec.z + m[0][3];
res.y = m[1][0] * vec.x + m[1][1] * vec.y + m[1][2] * vec.z + m[1][3];
res.z = m[2][0] * vec.x + m[2][1] * vec.y + m[2][2] * vec.z + m[2][3];
return res;
}
HVector HMatrix::getTranslation() {
return HVector(m[0][3], m[1][3], m[2][3]);
}
void HMatrix::glLoad() {
glLoadTransposeMatrixd((double*)m);
}
|