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