--- ray/src/common/fvect.c 1998/11/25 16:56:33 2.5 +++ ray/src/common/fvect.c 2003/09/16 06:30:20 2.8 @@ -1,30 +1,31 @@ -/* Copyright (c) 1998 Silicon Graphics, Inc. */ - #ifndef lint -static char SCCSid[] = "$SunId$ SGI"; +static const char RCSid[] = "$Id: fvect.c,v 2.8 2003/09/16 06:30:20 greg Exp $"; #endif - /* - * fvect.c - routines for float vector calculations - * - * 8/14/85 + * fvect.c - routines for floating-point vector calculations */ +#include "copyright.h" + #include #include "fvect.h" double -fdot(v1, v2) /* return the dot product of two vectors */ -register FVECT v1, v2; +fdot( /* return the dot product of two vectors */ +register FVECT v1, +register FVECT v2 +) { return(DOT(v1,v2)); } double -dist2(p1, p2) /* return square of distance between points */ -register FVECT p1, p2; +dist2( /* return square of distance between points */ +register FVECT p1, +register FVECT p2 +) { FVECT delta; @@ -37,9 +38,11 @@ register FVECT p1, p2; double -dist2line(p, ep1, ep2) /* return square of distance to line */ -FVECT p; /* the point */ -FVECT ep1, ep2; /* points on the line */ +dist2line( /* return square of distance to line */ +FVECT p, /* the point */ +FVECT ep1, +FVECT ep2 /* points on the line */ +) { register double d, d1, d2; @@ -52,9 +55,11 @@ FVECT ep1, ep2; /* points on the line */ double -dist2lseg(p, ep1, ep2) /* return square of distance to line segment */ -FVECT p; /* the point */ -FVECT ep1, ep2; /* the end points */ +dist2lseg( /* return square of distance to line segment */ +FVECT p, /* the point */ +FVECT ep1, +FVECT ep2 /* the end points */ +) { register double d, d1, d2; @@ -75,8 +80,12 @@ FVECT ep1, ep2; /* the end points */ } -fcross(vres, v1, v2) /* vres = v1 X v2 */ -register FVECT vres, v1, v2; +void +fcross( /* vres = v1 X v2 */ +register FVECT vres, +register FVECT v1, +register FVECT v2 +) { vres[0] = v1[1]*v2[2] - v1[2]*v2[1]; vres[1] = v1[2]*v2[0] - v1[0]*v2[2]; @@ -84,9 +93,13 @@ register FVECT vres, v1, v2; } -fvsum(vres, v0, v1, f) /* vres = v0 + f*v1 */ -register FVECT vres, v0, v1; -register double f; +void +fvsum( /* vres = v0 + f*v1 */ +register FVECT vres, +register FVECT v0, +register FVECT v1, +register double f +) { vres[0] = v0[0] + f*v1[0]; vres[1] = v0[1] + f*v1[1]; @@ -95,8 +108,9 @@ register double f; double -normalize(v) /* normalize a vector, return old magnitude */ -register FVECT v; +normalize( /* normalize a vector, return old magnitude */ +register FVECT v +) { register double len, d; @@ -118,9 +132,69 @@ register FVECT v; } -spinvector(vres, vorig, vnorm, theta) /* rotate vector around normal */ -FVECT vres, vorig, vnorm; -double theta; +int +closestapproach( /* closest approach of two rays */ +RREAL t[2], /* returned distances along each ray */ +FVECT rorg0, /* first origin */ +FVECT rdir0, /* first direction (normalized) */ +FVECT rorg1, /* second origin */ +FVECT rdir1 /* second direction (normalized) */ +) +{ + double dotprod = DOT(rdir0, rdir1); + double denom = 1. - dotprod*dotprod; + double o1o2_d1; + FVECT o0o1; + + if (denom <= FTINY) { /* check if lines are parallel */ + t[0] = t[1] = 0.0; + return(0); + } + VSUB(o0o1, rorg0, rorg1); + o1o2_d1 = DOT(o0o1, rdir1); + t[0] = (o1o2_d1*dotprod - DOT(o0o1,rdir0)) / denom; + t[1] = o1o2_d1 + t[0]*dotprod; + return(1); +} + + +#if 0 +int +closestapproach( /* closest approach of two rays */ +RREAL t[2], /* returned distances along each ray */ +FVECT rorg0, /* first origin */ +FVECT rdir0, /* first direction (unnormalized) */ +FVECT rorg1, /* second origin */ +FVECT rdir1 /* second direction (unnormalized) */ +) +{ + double dotprod = DOT(rdir0, rdir1); + double d0n2 = DOT(rdir0, rdir0); + double d1n2 = DOT(rdir1, rdir1); + double denom = d0n2*d1n2 - dotprod*dotprod; + double o1o2_d1; + FVECT o0o1; + + if (denom <= FTINY) { /* check if lines are parallel */ + t[0] = t[1] = 0.0; + return(0); + } + VSUB(o0o1, rorg0, rorg1); + o1o2_d1 = DOT(o0o1, rdir1); + t[0] = (o1o2_d1*dotprod - DOT(o0o1,rdir0)*d1n2) / denom; + t[1] = (o1o2_d1 + t[0]*dotprod) / d1n2; + return(1); +} +#endif + + +void +spinvector( /* rotate vector around normal */ +FVECT vres, /* returned vector */ +FVECT vorig, /* original vector */ +FVECT vnorm, /* normalized vector for rotation */ +double theta /* left-hand radians */ +) { double sint, cost, normprod; FVECT vperp;