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