| 14 |
|
|
| 15 |
|
#include "platform.h" |
| 16 |
|
#include "rtio.h" |
| 17 |
< |
#include "rtprocess.h" |
| 17 |
> |
#include "paths.h" |
| 18 |
|
#include "fvect.h" |
| 19 |
|
|
| 20 |
|
#ifdef M_PI |
| 23 |
|
#define PI 3.14159265358979323846 |
| 24 |
|
#endif |
| 25 |
|
|
| 26 |
– |
#define FEQ(a,b) ((a)-(b) <= 1e-7 && (b)-(a) <= 1e-7) |
| 27 |
– |
|
| 26 |
|
#define MAXVERT 6 /* maximum number of vertices for markers */ |
| 27 |
|
#define MAXMARK 128 /* maximum number of markers */ |
| 28 |
|
|
| 389 |
|
int n; |
| 390 |
|
double theta; |
| 391 |
|
|
| 392 |
+ |
if (yp[2]*yp[2] + zp[2]*zp[2] < 2.*FTINY*FTINY) { |
| 393 |
+ |
/* Special case for X' along Z-axis */ |
| 394 |
+ |
theta = -atan2(yp[0], yp[1]); |
| 395 |
+ |
sprintf(xf, " -ry %f -rz %f", |
| 396 |
+ |
xp[2] < 0.0 ? 90.0 : -90.0, |
| 397 |
+ |
theta*(180./PI)); |
| 398 |
+ |
return(4); |
| 399 |
+ |
} |
| 400 |
|
n = 0; |
| 401 |
|
theta = atan2(yp[2], zp[2]); |
| 402 |
< |
if (!FEQ(theta,0.0)) { |
| 402 |
> |
if (!FABSEQ(theta,0.0)) { |
| 403 |
|
sprintf(xf, " -rx %f", theta*(180./PI)); |
| 404 |
|
while (*xf) ++xf; |
| 405 |
|
n += 2; |
| 406 |
|
} |
| 407 |
< |
theta = asin(-xp[2]); |
| 408 |
< |
if (!FEQ(theta,0.0)) { |
| 407 |
> |
theta = Asin(-xp[2]); |
| 408 |
> |
if (!FABSEQ(theta,0.0)) { |
| 409 |
|
sprintf(xf, " -ry %f", theta*(180./PI)); |
| 410 |
|
while (*xf) ++xf; |
| 411 |
|
n += 2; |
| 412 |
|
} |
| 413 |
|
theta = atan2(xp[1], xp[0]); |
| 414 |
< |
if (!FEQ(theta,0.0)) { |
| 414 |
> |
if (!FABSEQ(theta,0.0)) { |
| 415 |
|
sprintf(xf, " -rz %f", theta*(180./PI)); |
| 416 |
|
/* while (*xf) ++xf; */ |
| 417 |
|
n += 2; |