| 1 |
#ifndef lint |
| 2 |
static const char RCSid[] = "$Id: mx3.c,v 2.2 2003/02/22 02:07:27 greg Exp $"; |
| 3 |
#endif |
| 4 |
|
| 5 |
#include "mx3.h" |
| 6 |
|
| 7 |
extern double |
| 8 |
mx3d_adjoint( |
| 9 |
register double a[3][3], |
| 10 |
register double b[3][3] |
| 11 |
) |
| 12 |
{ |
| 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 |
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 |
{ |
| 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 |
extern void |
| 46 |
mx3d_transform( |
| 47 |
register double p[3], |
| 48 |
register double a[3][3], |
| 49 |
register double q[3] |
| 50 |
) |
| 51 |
{ |
| 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 |
extern double |
| 59 |
mx3d_transform_div( |
| 60 |
register double p[3], |
| 61 |
register double a[3][3], |
| 62 |
register double q[2] |
| 63 |
) |
| 64 |
{ |
| 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 |
extern void |
| 76 |
mx3d_translate_mat( |
| 77 |
double tx, |
| 78 |
double ty, |
| 79 |
register double m[3][3] |
| 80 |
) |
| 81 |
{ |
| 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 |
extern void |
| 89 |
mx3d_translate( |
| 90 |
register double m[3][3], |
| 91 |
double tx, |
| 92 |
double ty |
| 93 |
) |
| 94 |
{ |
| 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 |
extern void |
| 102 |
mx3d_scale_mat( |
| 103 |
double sx, |
| 104 |
double sy, |
| 105 |
register double m[3][3] |
| 106 |
) |
| 107 |
{ |
| 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 |
extern void |
| 115 |
mx3d_scale( |
| 116 |
register double m[3][3], |
| 117 |
double sx, |
| 118 |
double sy |
| 119 |
) |
| 120 |
{ |
| 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 |
} |
