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
|
// Copyright (c) 1997 Philip A. Hardin (pahardin@cs.utexas.edu)
// This program is free software; you can redistribute it and/or modify
// it under the terms of the GNU General Public License v2 or later.
#include "fastpts.h"
/*=========================================================================*/
// Returns the index of the point added
FASTPTS_TEMPL_DECL
int FASTPTS::Add(const pnt& pt) {
pt3dPtr ptPtr;
bool wasAbsent;
int ptNum= pts.AddIfAbsent(pt,wasAbsent);
if (wasAbsent)
{ ptPtr.x= xdims.Add(pt.x,sdims);
ptPtr.y= ydims.Add(pt.y,sdims);
ptPtr.z= zdims.Add(pt.z,sdims);
ptPtrs.Add(ptPtr);
}
return ptNum;
}
/*-------------------------------------------------------------------------*/
// Add all points from 'newPts'
FASTPTS_TEMPL_DECL
void FASTPTS::Add(const pntTable& newPts) {
forii(newPts.Num())
Add(newPts[i]);
}
/*-------------------------------------------------------------------------*/
// This could easily be templatized to work w/ either tmtrx or double[4][4]
FASTPTS_TEMPL_DECL
void FASTPTS::TransformTo(const tmtrx& m, destPnt destPts[]) {
// compute the partial products for values in each dimension.
xdims.MakePartialProds(m[0]);
ydims.MakePartialProds(m[1]);
zdims.MakePartialProds(m[2]);
sdims.MakePartialProds();
// rotate points by adding the appropriate partial products
forii(ptPtrs.Num())
destPts[i]= ptPtrs[i].x->prod +
ptPtrs[i].y->prod +
ptPtrs[i].z->prod +pt3d(m[3]);
/*
pt3dPtr* ptPtr= ptPtrs.Array();
pt3dPtr* ptPtrsEnd= ptPtr + ptPtrs.Num();
while (ptPtr != ptPtrsEnd) {
*destPts++= ptPtr->x->prod +
ptPtr->y->prod +
ptPtr->z->prod; // +pt3d(m[3]);
ptPtr++;
}
*/
}
/*-------------------------------------------------------------------------*/
FASTPTS_TEMPL_DECL
FASTPTS&
FASTPTS::operator=(const FASTPTS& fp) {
pts.Empty();
ptPtrs.Empty();
xdims.Empty();
ydims.Empty();
zdims.Empty();
sdims.Empty();
Add(fp.pts);
return *this;
}
/*-------------------------------------------------------------------------*/
FASTPTS_TEMPL_DECL
ostream& operator<<(ostream& out, const FASTPTS& fp) {
int dimProps[dimension::numDimProps];
out << "Points:" << fp.pts.Num()
<< " xdims:" << fp.xdims.size()
<< " ydims:" << fp.ydims.size()
<< " zdims:" << fp.zdims.size() << "\n";
forii(dimension::numDimProps) dimProps[i]= 0;
fp.xdims.CountProps(dimProps);
fp.ydims.CountProps(dimProps);
fp.zdims.CountProps(dimProps);
out << "non-0 dims:" << fp.xdims.size() +fp.ydims.size() +fp.zdims.size();
out << " unique:" << dimProps[0] << " symmetric:" << dimProps[1]
<< " half:" << dimProps[2] << " quarter:" << dimProps[3];
return out << "\n";
}
|
