You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
88 lines
2.6 KiB
88 lines
2.6 KiB
// David Eberly, Geometric Tools, Redmond WA 98052
|
|
// Copyright (c) 1998-2021
|
|
// Distributed under the Boost Software License, Version 1.0.
|
|
// https://www.boost.org/LICENSE_1_0.txt
|
|
// https://www.geometrictools.com/License/Boost/LICENSE_1_0.txt
|
|
// Version: 4.0.2019.08.13
|
|
|
|
#pragma once
|
|
|
|
#include <Mathematics/Hypersphere.h>
|
|
#include <Mathematics/Vector2.h>
|
|
#include <vector>
|
|
|
|
namespace gte
|
|
{
|
|
// Compute the smallest bounding circle whose center is the average of
|
|
// the input points.
|
|
template <typename Real>
|
|
bool GetContainer(int numPoints, Vector2<Real> const* points, Circle2<Real>& circle)
|
|
{
|
|
circle.center = points[0];
|
|
for (int i = 1; i < numPoints; ++i)
|
|
{
|
|
circle.center += points[i];
|
|
}
|
|
circle.center /= (Real)numPoints;
|
|
|
|
circle.radius = (Real)0;
|
|
for (int i = 0; i < numPoints; ++i)
|
|
{
|
|
Vector2<Real> diff = points[i] - circle.center;
|
|
Real radiusSqr = Dot(diff, diff);
|
|
if (radiusSqr > circle.radius)
|
|
{
|
|
circle.radius = radiusSqr;
|
|
}
|
|
}
|
|
|
|
circle.radius = std::sqrt(circle.radius);
|
|
return true;
|
|
}
|
|
|
|
template <typename Real>
|
|
bool GetContainer(std::vector<Vector2<Real>> const& points, Circle2<Real>& circle)
|
|
{
|
|
return GetContainer(static_cast<int>(points.size()), points.data(), circle);
|
|
}
|
|
|
|
// Test for containment of a point inside a circle.
|
|
template <typename Real>
|
|
bool InContainer(Vector2<Real> const& point, Circle2<Real> const& circle)
|
|
{
|
|
Vector2<Real> diff = point - circle.center;
|
|
return Length(diff) <= circle.radius;
|
|
}
|
|
|
|
// Compute the smallest bounding circle that contains the input circles.
|
|
template <typename Real>
|
|
bool MergeContainers(Circle2<Real> const& circle0, Circle2<Real> const& circle1, Circle2<Real>& merge)
|
|
{
|
|
Vector2<Real> cenDiff = circle1.center - circle0.center;
|
|
Real lenSqr = Dot(cenDiff, cenDiff);
|
|
Real rDiff = circle1.radius - circle0.radius;
|
|
Real rDiffSqr = rDiff * rDiff;
|
|
|
|
if (rDiffSqr >= lenSqr)
|
|
{
|
|
merge = (rDiff >= (Real)0 ? circle1 : circle0);
|
|
}
|
|
else
|
|
{
|
|
Real length = std::sqrt(lenSqr);
|
|
if (length > (Real)0)
|
|
{
|
|
Real coeff = (length + rDiff) / (((Real)2)*length);
|
|
merge.center = circle0.center + coeff * cenDiff;
|
|
}
|
|
else
|
|
{
|
|
merge.center = circle0.center;
|
|
}
|
|
|
|
merge.radius = (Real)0.5 * (length + circle0.radius + circle1.radius);
|
|
}
|
|
|
|
return true;
|
|
}
|
|
}
|
|
|