43 |
|
extern double varvalue(); |
44 |
|
extern int errno; |
45 |
|
FVECT disp; |
46 |
+ |
double d; |
47 |
|
register XFORM *mxf; |
48 |
|
register int i; |
49 |
|
register char **sa; |
83 |
|
objerror(m, WARNING, "compute error"); |
84 |
|
return; |
85 |
|
} |
86 |
< |
if (mxf->fore.xfm == NULL) |
87 |
< |
for (i = 0; i < 3; i++) |
88 |
< |
r->pert[i] += disp[i]; |
89 |
< |
else |
90 |
< |
for (i = 0; i < 3; i++) |
90 |
< |
r->pert[i] += ( disp[0]*mxf->fore.xfm[0][i] + |
91 |
< |
disp[1]*mxf->fore.xfm[1][i] + |
92 |
< |
disp[2]*mxf->fore.xfm[2][i] ) |
93 |
< |
/ mxf->fore.sca; |
86 |
> |
multv3(disp, disp, mxf->fore.xfm); |
87 |
> |
multv3(disp, disp, r->rofx); |
88 |
> |
d = 1.0 / (mxf->fore.sca * r->rofs); |
89 |
> |
for (i = 0; i < 3; i++) |
90 |
> |
r->pert[i] += disp[i] * d; |
91 |
|
return; |
92 |
|
memerr: |
93 |
|
error(SYSTEM, "out of memory in t_func"); |