bool
GfFindClosestPoints(const GfRay &ray, const GfLine &line,
GfVec3d *rayPoint,
GfVec3d *linePoint,
double *rayDistance,
double *lineDistance)
{
GfLine l;
double len = l.Set(ray._startPoint, ray._direction);
GfVec3d rp, lp;
double rd,ld;
if (!GfFindClosestPoints(l, line, &rp, &lp, &rd, &ld))
return false;
if (rd < 0.0) rd = 0.0;
if (rayPoint)
*rayPoint = l.GetPoint(rd);
if (linePoint)
*linePoint = lp;
if (rayDistance)
*rayDistance = rd / len;
if (lineDistance)
*lineDistance = ld;
return true;
}
bool
GfFindClosestPoints(const GfRay &ray, const GfLineSeg &seg,
GfVec3d *rayPoint,
GfVec3d *segPoint,
double *rayDistance,
double *segDistance)
{
GfLine l;
double len = l.Set(ray._startPoint, ray._direction);
GfVec3d rp, sp;
double rd,sd;
if (!GfFindClosestPoints(l, seg, &rp, &sp, &rd, &sd))
return false;
if (rd < 0.0) rd = 0.0;
if (rayPoint)
*rayPoint = l.GetPoint(rd);
if (segPoint)
*segPoint = sp;
if (rayDistance)
*rayDistance = rd / len;
if (segDistance)
*segDistance = sd;
return true;
}
GfVec3d
GfRay::FindClosestPoint(const GfVec3d &point, double *rayDistance) const
{
GfLine l;
double len = l.Set(_startPoint, _direction);
double lrd;
(void) l.FindClosestPoint(point, &lrd);
if (lrd < 0.0) lrd = 0.0;
if (rayDistance)
*rayDistance = lrd / len;
return l.GetPoint(lrd);
}