295 |
|
} |
296 |
|
|
297 |
|
|
298 |
– |
spinvector(vres, vorig, vnorm, theta) /* rotate vector around normal */ |
299 |
– |
FVECT vres, vorig, vnorm; |
300 |
– |
double theta; |
301 |
– |
{ |
302 |
– |
extern double sin(), cos(); |
303 |
– |
double sint, cost, dotp; |
304 |
– |
FVECT vperp; |
305 |
– |
register int i; |
306 |
– |
|
307 |
– |
sint = sin(theta); |
308 |
– |
cost = cos(theta); |
309 |
– |
dotp = DOT(vorig, vnorm); |
310 |
– |
fcross(vperp, vnorm, vorig); |
311 |
– |
for (i = 0; i < 3; i++) |
312 |
– |
vres[i] = vnorm[i]*dotp*(1.-cost) + |
313 |
– |
vorig[i]*cost + vperp[i]*sint; |
314 |
– |
} |
315 |
– |
|
316 |
– |
|
298 |
|
memerr(s) /* malloc failure */ |
299 |
|
char *s; |
300 |
|
{ |