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 |
+ |
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[0]*mxf->fore.xfm[0][i] + |
87 |
< |
disp[1]*mxf->fore.xfm[1][i] + |
88 |
< |
disp[2]*mxf->fore.xfm[2][i] ) |
89 |
< |
/ mxf->fore.sca; |
90 |
> |
r->pert[i] += disp[i] * d; |
91 |
|
return; |
92 |
|
memerr: |
93 |
|
error(SYSTEM, "out of memory in t_func"); |