blob: 2933030e4b59ef0f28b738702df52c3828c5a859 (
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
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
|
/*
**************************************************************************
description
--------------------
copyright : (C) 2000-2001 by Andreas Zehender
email : [email protected]
**************************************************************************
**************************************************************************
* *
* This program is free software; you can redistribute it and/or modify *
* it under the terms of the GNU General Public License as published by *
* the Free Software Foundation; either version 2 of the License, or *
* (at your option) any later version. *
* *
**************************************************************************/
#include "pmpoint.h"
#include "pmvector.h"
#include "pmmatrix.h"
#include "pmmath.h"
PMPoint::PMPoint( )
{
m_coord[0] = 0;
m_coord[1] = 0;
m_coord[2] = 0;
}
PMPoint::PMPoint( GLdouble x, GLdouble y, GLdouble z )
{
m_coord[0] = x;
m_coord[1] = y;
m_coord[2] = z;
}
PMPoint::PMPoint( const PMVector& v )
{
if( v.size( ) == 3 )
{
m_coord[0] = v[0];
m_coord[1] = v[1];
m_coord[2] = v[2];
}
else
{
m_coord[0] = 0;
m_coord[1] = 0;
m_coord[2] = 0;
}
}
PMPoint::PMPoint( const PMPoint& p )
{
m_coord[0] = p.m_coord[0];
m_coord[1] = p.m_coord[1];
m_coord[2] = p.m_coord[2];
}
PMPoint& PMPoint::operator= ( const PMPoint& p )
{
m_coord[0] = p.m_coord[0];
m_coord[1] = p.m_coord[1];
m_coord[2] = p.m_coord[2];
return *this;
}
void PMPoint::transform( const PMMatrix& m )
{
(*this) = m * (*this);
}
PMPoint operator* ( const PMMatrix& m, const PMPoint& p )
{
PMPoint result;
int c, i;
// for homogenous coordinates
double u;
for( c = 0; c < 3; c++ )
{
result.m_coord[c] = 0.0;
for( i = 0; i < 4; i++ )
result.m_coord[c] += m[i][c] * ( i<3 ? p[i] : 1.0 );
}
u = 0.0;
for( i = 0; i < 4; i++ )
u += m[i][3] * ( i<3 ? p[i] : 1.0 );
if( !approxZero( u ) )
for( i = 0; i < 3; i++ )
result.m_coord[i] /= u;
return result;
}
|
