1 |
greg |
2.1 |
#ifndef lint |
2 |
greg |
2.2 |
static const char RCSid[] = "$Id$"; |
3 |
greg |
2.1 |
#endif |
4 |
|
|
|
5 |
|
|
double |
6 |
|
|
mx3d_adjoint(a, b) |
7 |
|
|
register double a[3][3], b[3][3]; |
8 |
|
|
{ |
9 |
|
|
b[0][0] = ((a[1][1])*( a[2][2]) - ( a[1][2])*( a[2][1])); |
10 |
|
|
b[1][0] = ((a[1][2])*( a[2][0]) - ( a[1][0])*( a[2][2])); |
11 |
|
|
b[2][0] = ((a[1][0])*( a[2][1]) - ( a[1][1])*( a[2][0])); |
12 |
|
|
b[0][1] = ((a[2][1])*( a[0][2]) - ( a[2][2])*( a[0][1])); |
13 |
|
|
b[1][1] = ((a[2][2])*( a[0][0]) - ( a[2][0])*( a[0][2])); |
14 |
|
|
b[2][1] = ((a[2][0])*( a[0][1]) - ( a[2][1])*( a[0][0])); |
15 |
|
|
b[0][2] = ((a[0][1])*( a[1][2]) - ( a[0][2])*( a[1][1])); |
16 |
|
|
b[1][2] = ((a[0][2])*( a[1][0]) - ( a[0][0])*( a[1][2])); |
17 |
|
|
b[2][2] = ((a[0][0])*( a[1][1]) - ( a[0][1])*( a[1][0])); |
18 |
|
|
return a[0][0]*b[0][0] + a[1][0]*b[0][1] + a[2][0]*b[0][2]; |
19 |
|
|
} |
20 |
|
|
|
21 |
|
|
|
22 |
|
|
mx3d_mul(a, b, c) |
23 |
|
|
register double a[3][3], b[3][3], c[3][3]; |
24 |
|
|
{ |
25 |
|
|
c[0][0] = a[0][0]*b[0][0] + a[0][1]*b[1][0] + a[0][2]*b[2][0]; |
26 |
|
|
c[0][1] = a[0][0]*b[0][1] + a[0][1]*b[1][1] + a[0][2]*b[2][1]; |
27 |
|
|
c[0][2] = a[0][0]*b[0][2] + a[0][1]*b[1][2] + a[0][2]*b[2][2]; |
28 |
|
|
c[1][0] = a[1][0]*b[0][0] + a[1][1]*b[1][0] + a[1][2]*b[2][0]; |
29 |
|
|
c[1][1] = a[1][0]*b[0][1] + a[1][1]*b[1][1] + a[1][2]*b[2][1]; |
30 |
|
|
c[1][2] = a[1][0]*b[0][2] + a[1][1]*b[1][2] + a[1][2]*b[2][2]; |
31 |
|
|
c[2][0] = a[2][0]*b[0][0] + a[2][1]*b[1][0] + a[2][2]*b[2][0]; |
32 |
|
|
c[2][1] = a[2][0]*b[0][1] + a[2][1]*b[1][1] + a[2][2]*b[2][1]; |
33 |
|
|
c[2][2] = a[2][0]*b[0][2] + a[2][1]*b[1][2] + a[2][2]*b[2][2]; |
34 |
|
|
} |
35 |
|
|
|
36 |
|
|
|
37 |
|
|
mx3d_transform(p, a, q) |
38 |
|
|
register double p[3], q[3]; |
39 |
|
|
register double a[3][3]; |
40 |
|
|
{ |
41 |
|
|
q[0] = p[0]*a[0][0] + p[1]*a[1][0] + p[2]*a[2][0]; |
42 |
|
|
q[1] = p[0]*a[0][1] + p[1]*a[1][1] + p[2]*a[2][1]; |
43 |
|
|
q[2] = p[0]*a[0][2] + p[1]*a[1][2] + p[2]*a[2][2]; |
44 |
|
|
} |
45 |
|
|
|
46 |
|
|
|
47 |
|
|
double |
48 |
|
|
mx3d_transform_div(p, a, q) |
49 |
|
|
register double p[3], q[2]; |
50 |
|
|
register double a[3][3]; |
51 |
|
|
{ |
52 |
|
|
double q2; |
53 |
|
|
q2 = p[0]*a[0][2] + p[1]*a[1][2] + p[2]*a[2][2]; |
54 |
|
|
if (q2!=0.) { |
55 |
|
|
q[0] = (p[0]*a[0][0] + p[1]*a[1][0] + p[2]*a[2][0]) / q2; |
56 |
|
|
q[1] = (p[0]*a[0][1] + p[1]*a[1][1] + p[2]*a[2][1]) / q2; |
57 |
|
|
} |
58 |
|
|
return q2; |
59 |
|
|
} |
60 |
|
|
|
61 |
|
|
|
62 |
|
|
mx3d_translate_mat(tx, ty, m) |
63 |
|
|
double tx, ty; |
64 |
|
|
register double m[3][3]; |
65 |
|
|
{ |
66 |
|
|
m[0][0] = 1.; m[0][1] = 0.; m[0][2] = 0.; |
67 |
|
|
m[1][0] = 0.; m[1][1] = 1.; m[1][2] = 0.; |
68 |
|
|
m[2][0] = tx; m[2][1] = ty; m[2][2] = 1.; |
69 |
|
|
} |
70 |
|
|
|
71 |
|
|
|
72 |
|
|
mx3d_translate(m, tx, ty) |
73 |
|
|
register double m[3][3]; |
74 |
|
|
double tx, ty; |
75 |
|
|
{ |
76 |
|
|
m[3][0] += tx*m[0][0]+ty*m[1][0]; |
77 |
|
|
m[3][1] += tx*m[0][1]+ty*m[1][1]; |
78 |
|
|
m[3][2] += tx*m[0][2]+ty*m[1][2]; |
79 |
|
|
} |
80 |
|
|
|
81 |
|
|
|
82 |
|
|
mx3d_scale_mat(sx, sy, m) |
83 |
|
|
double sx, sy; |
84 |
|
|
register double m[3][3]; |
85 |
|
|
{ |
86 |
|
|
m[0][0] = sx; m[0][1] = 0.; m[0][2] = 0.; |
87 |
|
|
m[1][0] = 0.; m[1][1] = sy; m[1][2] = 0.; |
88 |
|
|
m[2][0] = 0.; m[2][1] = 0.; m[2][2] = 1.; |
89 |
|
|
} |
90 |
|
|
|
91 |
|
|
|
92 |
|
|
mx3d_scale(m, sx, sy) |
93 |
|
|
register double m[3][3]; |
94 |
|
|
double sx, sy; |
95 |
|
|
{ |
96 |
|
|
m[0][0] *= sx; m[0][1] *= sx; m[0][2] *= sx; |
97 |
|
|
m[1][0] *= sy; m[1][1] *= sy; m[1][2] *= sy; |
98 |
|
|
} |