| 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 |
}
|
