1 |
/* Copyright (c) 1998 Silicon Graphics, Inc. */ |
2 |
|
3 |
/* SCCSid "$SunId$ SGI" */ |
4 |
|
5 |
#ifdef SMLFLT |
6 |
#define FLOAT float |
7 |
#define FTINY (1e-3) |
8 |
#else |
9 |
#define FLOAT double |
10 |
#define FTINY (1e-6) |
11 |
#endif |
12 |
#define FHUGE (1e10) |
13 |
|
14 |
typedef FLOAT FVECT[3]; |
15 |
|
16 |
#define VCOPY(v1,v2) ((v1)[0]=(v2)[0],(v1)[1]=(v2)[1],(v1)[2]=(v2)[2]) |
17 |
#define DOT(v1,v2) ((v1)[0]*(v2)[0]+(v1)[1]*(v2)[1]+(v1)[2]*(v2)[2]) |
18 |
#define VLEN(v) sqrt(DOT(v,v)) |
19 |
#define VADD(vr,v1,v2) ((vr)[0]=(v1)[0]+(v2)[0], \ |
20 |
(vr)[1]=(v1)[1]+(v2)[1], \ |
21 |
(vr)[2]=(v1)[2]+(v2)[2]) |
22 |
#define VSUB(vr,v1,v2) ((vr)[0]=(v1)[0]-(v2)[0], \ |
23 |
(vr)[1]=(v1)[1]-(v2)[1], \ |
24 |
(vr)[2]=(v1)[2]-(v2)[2]) |
25 |
#define VSUM(vr,v1,v2,f) ((vr)[0]=(v1)[0]+(f)*(v2)[0], \ |
26 |
(vr)[1]=(v1)[1]+(f)*(v2)[1], \ |
27 |
(vr)[2]=(v1)[2]+(f)*(v2)[2]) |
28 |
#define VCROSS(vr,v1,v2) \ |
29 |
((vr)[0]=(v1)[1]*(v2)[2]-(v1)[2]*(v2)[1], \ |
30 |
(vr)[1]=(v1)[2]*(v2)[0]-(v1)[0]*(v2)[2], \ |
31 |
(vr)[2]=(v1)[0]*(v2)[1]-(v1)[1]*(v2)[0]) |
32 |
|
33 |
extern double fdot(), dist2(), dist2lseg(), dist2line(), normalize(); |