public static bool IsRectangle(List <Vec2d> poly, double epsilon)
{
bool result = poly.Count == 4;
if (result)
{
// Check angles
for (int i = 0; result && i < poly.Count - 1; ++i)
{
int j = i + 1;
int k = (i + 2) % poly.Count;
Vec2d v1 = poly[j] - poly[i];
Vec2d v2 = poly[k] - poly[j];
v1.Normalize();
v2.Normalize();
double angle = Vec2d.AngleBetweenVectors(v1, v2);
while (angle < -Math.PI)
{
angle += 2.0 * Math.PI;
}
while (angle >= Math.PI)
{
angle -= 2.0 * Math.PI;
}
angle = Math.Abs(angle);
result = Math.Abs(angle - 0.5 * Math.PI) < epsilon;
}
}
return(result);
}
public void Normalize()
{
var p2 = new Vec2d(1, 23);
Assert.That(new Vec2d(0.04343722427630694, 0.9990561583550596).IsEqual(p2.Normalized(), 0.0000001, 0.0000001));
p2.Normalize();
Assert.That(new Vec2d(0.04343722427630694, 0.9990561583550596).IsEqual(p2, 0.0000001, 0.0000001));
}
public void ValueType_Vec2d()
{
var p1 = new Vec2d(1, 0);
var p2 = new Vec2d(0, 1);
Assert.IsFalse(p1.IsEqual(p2, 0.99, 0.1));
Assert.IsTrue(p1.IsEqual(p2, 1.01, 0.1));
Assert.IsTrue(p1.IsEqual(p2, 0.99, Math.PI / 2));
Assert.IsTrue(p1.IsNormal(p2, 0.1));
Assert.IsFalse(p1.IsOpposite(p2, 0.1));
Assert.IsTrue(p1.IsOpposite(p2, Math.PI / 2));
Assert.IsFalse(p1.IsParallel(p2, 0.1));
Assert.IsTrue(p1.IsParallel(p2, Math.PI / 2));
p1 = new Vec2d(1, 2);
p2 = new Vec2d(4, 5);
Assert.AreEqual(5, p1.SquareMagnitude());
Assert.AreEqual(Math.Sqrt(5), p1.Magnitude());
p2 = p1;
p2.Add(new Vec2d(1, 2));
Assert.AreEqual(new Vec2d(2, 4), p2);
Assert.AreEqual(new Vec2d(2, 4), p1.Added(new Vec2d(1, 2)));
p2 = new Vec2d(1, 2);
p2.Subtract(new Vec2d(3, 2));
Assert.AreEqual(new Vec2d(-2, 0), p2);
Assert.AreEqual(new Vec2d(-2, 0), p1.Subtracted(new Vec2d(3, 2)));
p2 = new Vec2d(1, 2);
Assert.AreEqual(-4, p1.Crossed(new Vec2d(3, 2)));
Assert.AreEqual(Math.Sqrt(16), p1.CrossMagnitude(new Vec2d(3, 2)));
Assert.AreEqual(16, p1.CrossSquareMagnitude(new Vec2d(3, 2)));
p2 = new Vec2d(1, 2);
p2.Divide(2);
Assert.AreEqual(new Vec2d(0.5, 1), p2);
Assert.AreEqual(new Vec2d(0.5, 1), p1.Divided(2));
Assert.AreEqual(5, p1.Dot(new Vec2d(1, 2)));
p2 = new Vec2d(1, 2);
p2.Multiply(2);
Assert.AreEqual(new Vec2d(2, 4), p2);
Assert.AreEqual(new Vec2d(2, 4), p1.Multiplied(2));
p2 = new Vec2d(1, 2);
p2.Scale(2);
Assert.AreEqual(new Vec2d(2, 4), p2);
Assert.AreEqual(new Vec2d(2, 4), p1.Scaled(2));
p2 = new Vec2d(1, 23);
Assert.AreEqual("0.0434372242763069,0.99905615835506", p2.Normalized().ToString());
p2.Normalize();
Assert.AreEqual("0.0434372242763069,0.99905615835506", p2.ToString());
p2 = new Vec2d(1, 2);
p2.Reverse();
Assert.AreEqual(new Vec2d(-1, -2), p2);
Assert.AreEqual(new Vec2d(-1, -2), p1.Reversed());
p2.SetLinearForm(new Vec2d(1, 2), new Vec2d(4, 5));
Assert.AreEqual(new Vec2d(5, 7), p2);
p2.SetLinearForm(2, new Vec2d(1, 2), new Vec2d(4, 5));
Assert.AreEqual(new Vec2d(6, 9), p2);
p2.SetLinearForm(2, new Vec2d(1, 2), 3, new Vec2d(4, 5));
Assert.AreEqual(new Vec2d(14, 19), p2);
p2.SetLinearForm(2, new Vec2d(1, 2), 3, new Vec2d(4, 5), new Vec2d(7, 8));
Assert.AreEqual(new Vec2d(21, 27), p2);
p2 = new Vec2d(2, 1);
Assert.AreEqual(new Vec2d(1, 0), p2.Mirrored(new Vec2d(1, 0)));
p2.Mirror(new Vec2d(1, 0));
Assert.AreEqual(new Vec2d(1, 0), p2);
var m2 = new Ax2d(new Pnt2d(-1, 2), new Dir2d(-1, 0));
p2 = new Vec2d(2, 1);
Assert.AreEqual(new Vec2d(2, -1), p2.Mirrored(m2));
p2.Mirror(m2);
Assert.AreEqual(new Vec2d(2, -1), p2);
p2 = new Vec2d(2, 1);
Assert.AreEqual("-1,2", p2.Rotated(Math.PI / 2).ToString());
p2.Rotate(Math.PI / 2);
Assert.AreEqual("-1,2", p2.ToString());
//TestContext.WriteLine(string.Format(CultureInfo.InvariantCulture, "{0},{1},{2}", gp2.x, gp2.y, gp2.z));
Trsf2d t1 = new Trsf2d();
t1.SetRotation(new Pnt2d(1, 2), Math.PI / 2);
p2 = new Vec2d(2, 1);
Assert.AreEqual("-1,2", p2.Transformed(t1).ToString());
p2.Transform(t1);
Assert.AreEqual("-1,2", p2.ToString());
}