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
|
/*
* $XFree86: $
*
* Copyright © 2002 University of Southern California
*
* Permission to use, copy, modify, distribute, and sell this software
* and its documentation for any purpose is hereby granted without
* fee, provided that the above copyright notice appear in all copies
* and that both that copyright notice and this permission notice
* appear in supporting documentation, and that the name of University
* of Southern California not be used in advertising or publicity
* pertaining to distribution of the software without specific,
* written prior permission. University of Southern California makes
* no representations about the suitability of this software for any
* purpose. It is provided "as is" without express or implied
* warranty.
*
* UNIVERSITY OF SOUTHERN CALIFORNIA DISCLAIMS ALL WARRANTIES WITH
* REGARD TO THIS SOFTWARE, INCLUDING ALL IMPLIED WARRANTIES OF
* MERCHANTABILITY AND FITNESS, IN NO EVENT SHALL UNIVERSITY OF
* SOUTHERN CALIFORNIA BE LIABLE FOR ANY SPECIAL, INDIRECT OR
* CONSEQUENTIAL DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS
* OF USE, DATA OR PROFITS, WHETHER IN AN ACTION OF CONTRACT,
* NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN
* CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
*
* Author: Carl Worth, USC, Information Sciences Institute */
#include <stdlib.h>
#include <math.h>
#include "xrint.h"
static XrTransform XR_TRANSFORM_DEFAULT = {
{1, 0,
0, 1,
0, 0}
};
void
XrTransformInit(XrTransform *transform)
{
*transform = XR_TRANSFORM_DEFAULT;
}
void
XrTransformInitMatrix(XrTransform *transform,
double a, double b,
double c, double d,
double tx, double ty)
{
transform->matrix[0] = a; transform->matrix[1] = b;
transform->matrix[2] = c; transform->matrix[3] = d;
transform->matrix[4] = tx; transform->matrix[5] = ty;
}
void
XrTransformInitTranslate(XrTransform *transform,
double tx, double ty)
{
XrTransformInitMatrix(transform,
1, 0,
0, 1,
tx, ty);
}
void
XrTransformInitScale(XrTransform *transform,
double sx, double sy)
{
XrTransformInitMatrix(transform,
sx, 0,
0, sy,
0, 0);
}
void
XrTransformInitRotate(XrTransform *transform,
double angle)
{
XrTransformInitMatrix(transform,
cos(angle), sin(angle),
-sin(angle), cos(angle),
0, 0);
}
void
XrTransformDeinit(XrTransform *transform)
{
/* Nothing to do here */
}
void
XrTransformCompose(XrTransform *t1, const XrTransform *t2)
{
double new[6];
new[0] = t2->matrix[0] * t1->matrix[0] + t2->matrix[1] * t1->matrix[2];
new[1] = t2->matrix[0] * t1->matrix[1] + t2->matrix[1] * t1->matrix[3];
new[2] = t2->matrix[2] * t1->matrix[0] + t2->matrix[3] * t1->matrix[2];
new[3] = t2->matrix[2] * t1->matrix[1] + t2->matrix[3] * t1->matrix[3];
new[4] = t2->matrix[4] * t1->matrix[0] + t2->matrix[5] * t1->matrix[2] + t1->matrix[4];
new[5] = t2->matrix[4] * t1->matrix[1] + t2->matrix[5] * t1->matrix[3] + t1->matrix[5];
memcpy(t1->matrix, new, 6 * sizeof(double));
}
void
XrTransformPointWithoutTranslate(XrTransform *transform, XPointDouble *pt)
{
double new_x, new_y;
new_x = (transform->matrix[0] * pt->x
+ transform->matrix[2] * pt->y);
new_y = (transform->matrix[1] * pt->x
+ transform->matrix[3] * pt->y);
pt->x = new_x;
pt->y = new_y;
}
void
XrTransformPoint(XrTransform *transform, XPointDouble *pt)
{
XrTransformPointWithoutTranslate(transform, pt);
pt->x += transform->matrix[4];
pt->y += transform->matrix[5];
}
|