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