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
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
|
/*****************************************************************************
** This is part of the CTSim program
** Copyright (c) 1983-2001 Kevin Rosenberg
**
** $Id: xform.cpp 7061 2003-09-07 06:34:45Z kevin $
**
** This program is free software; you can redistribute it and/or modify
** it under the terms of the GNU General Public License (version 2) as
** published by the Free Software Foundation.
**
** This program is distributed in the hope that it will be useful,
** but WITHOUT ANY WARRANTY; without even the implied warranty of
** MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
** GNU General Public License for more details.
**
** You should have received a copy of the GNU General Public License
** along with this program; if not, write to the Free Software
** Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
******************************************************************************/
#include "ctsupport.h"
/* NAME
* rotate2d Rotates an array of 2 dimensional vectors
*
* SYNOPSIS
* rotate2d (x, y, n, angle)
* double x[], y[] Array of points
* int n Number of points in array
* double angle Rotation angle (counter-clockwise)
*/
void
rotate2d (double x[], double y[], int n, double angle)
{
double cos_theta = cos (angle);
double sin_theta = sin (angle);
for (int i = 0; i < n; i++) {
double xrot = x[i] * cos_theta - y[i] * sin_theta;
double yrot = x[i] * sin_theta + y[i] * cos_theta;
x[i] = xrot;
y[i] = yrot;
}
}
/* NAME
* xlat2d Translates an array of 2 dimensional vectors
*
* SYNOPSIS
* xlat2d (x, y, n, xoffset, yoffset)
* double x[], y[] Array of points
* int n Number of points in array
* double xoffset, yoffset Offset to translate points by
*/
void
xlat2d (double x[], double y[], int n, double xoffset, double yoffset)
{
for (int i = 0; i < n; i++) {
x[i] += xoffset;
y[i] += yoffset;
}
}
/* NAME
* scale2d Scale an array of 2 dimensional vectors
*
* SYNOPSIS
* scale2d (x, y, n, xoffset, yoffset)
* double x[], y[] Array of points
* int n Number of points in array
* double xfact, yfact x & y scaling factors
*/
void
scale2d (double x[], double y[], int n, double xfact, double yfact)
{
for (int i = 0; i < n; i++) {
x[i] *= xfact;
y[i] *= yfact;
}
}
void
indent_mtx2 (GRFMTX_2D m)
{
m[0][0] = 1.0; m[0][1] = 0.0; m[0][2] = 0.0;
m[1][0] = 0.0; m[1][1] = 1.0; m[1][2] = 0.0;
m[2][0] = 0.0; m[2][1] = 0.0; m[2][2] = 1.0;
}
void
xlat_mtx2 (GRFMTX_2D m, const double x, const double y)
{
indent_mtx2 (m);
m[2][0] = x;
m[2][1] = y;
}
void
scale_mtx2 (GRFMTX_2D m, const double sx, const double sy)
{
indent_mtx2 (m);
m[0][0] = sx;
m[1][1] = sy;
}
void
rot_mtx2 (GRFMTX_2D m, const double theta)
{
double c = cos(theta);
double s = sin(theta);
indent_mtx2 (m);
m[0][0] = c; m[0][1] = s;
m[1][0] = -s; m[1][1] = c;
}
void
mult_mtx2 (const GRFMTX_2D m1, const GRFMTX_2D m2, GRFMTX_2D result)
{
GRFMTX_2D temp;
for (int row = 0; row < 3; row++) {
for (int col = 0; col < 3; col++) {
temp[row][col] = 0;
for (int calc = 0; calc < 3; calc++)
temp[row][col] += m1[row][calc] * m2[calc][col];
}
}
for (int r = 0; r < 3; r++)
for (int col = 0; col < 3; col++)
result[r][col] = temp[r][col];
}
void
xform_mtx2 (const GRFMTX_2D m, double& x, double& y)
{
double xt = x * m[0][0] + y * m[1][0] + m[2][0];
double yt = x * m[0][1] + y * m[1][1] + m[2][1];
x = xt;
y = yt;
}
|
