public static Vector2D[] GetIntersection(Vector2D[] vertexes, Line line)
{
Scalar[] distances = new Scalar[vertexes.Length];
for (int index = 0; index < vertexes.Length; ++index)
{
line.GetDistance(ref vertexes[index], out distances[index]);
}
Scalar lastDistance = distances[distances.Length - 1];
Vector2D lastVertex = vertexes[vertexes.Length - 1];
Vector2D vertex;
Scalar distance;
List<Vector2D> result = new List<Vector2D>(vertexes.Length + 1);
for (int index = 0; index < vertexes.Length; ++index, lastVertex = vertex, lastDistance = distance)
{
vertex = vertexes[index];
distance = distances[index];
if (Math.Abs(Math.Sign(distance) - Math.Sign(lastDistance)) == 2)
{
Scalar lastABS = Math.Abs(lastDistance);
Scalar total = (lastABS + Math.Abs(distance));
Scalar percent = lastABS / total;
Vector2D intersection;
Vector2D.Lerp(ref lastVertex, ref vertex, ref percent, out intersection);
result.Add(intersection);
}
if (distance >= 0)
{
result.Add(vertex);
}
}
return result.ToArray();
}
