public bool intersectWith(Line2D l, Vector2D o)
{
bool found = false;
float a1, a2, b1, b2;
// calculate slopes, deal with infinity
if (End.X - Start.X == 0)
b1 = (float)1e+10;
else
b1 = (End.Y - Start.Y) / (End.X - Start.X);
if (l.End.X - l.Start.X == 0)
b2 = (float)1e+10;
else
b2 = (l.End.Y - l.Start.Y) / (l.End.X - l.Start.X);
// calculate position
a1 = Start.Y - b1 * Start.X;
a2 = l.Start.Y - b2 * l.Start.X;
o.X = -(a1 - a2) / (b1 - b2);
o.Y = a1 + b1 * o.X;
// did the lines cross?
if ((Start.X - o.X) * (o.X - End.X) >= -ROUNDING_ERROR_32 &&
(l.Start.X - o.X) * (o.X - l.End.X) >= -ROUNDING_ERROR_32 &&
(Start.Y - o.Y) * (o.Y - End.Y) >= -ROUNDING_ERROR_32 &&
(l.Start.Y - o.Y) * (o.Y - l.End.Y) >= -ROUNDING_ERROR_32)
{
found = true;
}
return found;
}
public double GetAngleWith(Line2D l)
{
Vector2D vect = Vector;
Vector2D vect2 = l.Vector;
return vect.GetAngleWith(vect2);
}
public static Line2D From(float xMin, float yMin, float xMax, float yMax)
{
Line2D line = new Line2D();
line.Start = new Vector2D();
line.End = new Vector2D();
line.Start.Set(xMin, yMin);
line.End.Set(xMax, yMax);
return line;
}