public void TestEqualityOperator() { Line3 line1 = new Line3( new Vector3(100.0f, 200.0f, 300.0f), new Vector3(400.0f, 500.0f, 600.0f) ); Line3 line2 = new Line3(line1); Assert.AreEqual(line1, line2, "Copied line is equal to the original line"); line1.Offset.X = 0.0f; Assert.AreNotEqual(line1, line2, "Modified copy is no longer equal to the original line"); line1.Offset.X = 100.0f; line1.Offset.Y = 0.0f; Assert.AreNotEqual(line1, line2, "Modified copy is no longer equal to the original line"); line1.Offset.Y = 200.0f; line1.Offset.Z = 0.0f; Assert.AreNotEqual(line1, line2, "Modified copy is no longer equal to the original line"); line1.Offset.Z = 300.0f; line1.Direction.X = 0.0f; Assert.AreNotEqual(line1, line2, "Modified copy is no longer equal to the original line"); line1.Direction.X = 400.0f; line1.Direction.Y = 0.0f; Assert.AreNotEqual(line1, line2, "Modified copy is no longer equal to the original line"); line1.Direction.Y = 500.0f; line1.Direction.Z = 0.0f; Assert.AreNotEqual(line1, line2, "Modified copy is no longer equal to the original line"); line1.Direction.Z = 600.0f; }
public void TestConstructor() { Line3 line = new Line3(new Vector3(1.0f, 2.0f, 3.0f), new Vector3(4.0f, 5.0f, 6.0f)); Assert.AreEqual(1.0f, line.Offset.X, "X offset is taken over from constructor"); Assert.AreEqual(2.0f, line.Offset.Y, "Y offset is taken over from constructor"); Assert.AreEqual(3.0f, line.Offset.Z, "Z offset is taken over from constructor"); Assert.AreEqual(4.0f, line.Direction.X, "X direction is taken over from constructor"); Assert.AreEqual(5.0f, line.Direction.Y, "Y direction is taken over from constructor"); Assert.AreEqual(6.0f, line.Direction.Z, "Z direction is taken over from constructor"); }
public void TestClosestPoint() { // Test whether the closest point determination works on the X axis Line3 line = new Line3(new Vector3(0.0f, 100.0f, 100.0f), Vector3.Right); Vector3 leftCap = line.ClosestPointTo(new Vector3(-2.0f, 200.0f, 200.0f)); Assert.AreEqual( new Vector3(-2.0f, 100.0f, 100.0f), leftCap, "Closest point beyond left end found" ); Vector3 leftPoint = line.ClosestPointTo(new Vector3(0.0f, 200.0f, 200.0f)); Assert.AreEqual( new Vector3(0.0f, 100.0f, 100.0f), leftPoint, "Closest point on left end found" ); Vector3 midLeftRight = line.ClosestPointTo(new Vector3(0.5f, 200.0f, 200.0f)); Assert.AreEqual( new Vector3(0.5f, 100.0f, 100.0f), midLeftRight, "Closest point inmidst of line found" ); Vector3 rightPoint = line.ClosestPointTo(new Vector3(1.0f, 200.0f, 200.0f)); Assert.AreEqual( new Vector3(1.0f, 100.0f, 100.0f), rightPoint, "Closest point on right end found" ); Vector3 rightCap = line.ClosestPointTo(new Vector3(3.0f, 200.0f, 200.0f)); Assert.AreEqual( new Vector3(3.0f, 100.0f, 100.0f), rightCap, "Closest point beyond right end found" ); // Test whether the closest point determination works on the Y axis line = new Line3(new Vector3(100.0f, 0.0f, 100.0f), Vector3.Up); leftCap = line.ClosestPointTo(new Vector3(200.0f, -2.0f, 200.0f)); Assert.AreEqual( new Vector3(100.0f, -2.0f, 100.0f), leftCap, "Closest point beyond lower end found" ); leftPoint = line.ClosestPointTo(new Vector3(200.0f, 0.0f, 200.0f)); Assert.AreEqual( new Vector3(100.0f, 0.0f, 100.0f), leftPoint, "Closest point on lower end found" ); midLeftRight = line.ClosestPointTo(new Vector3(200.0f, 0.5f, 200.0f)); Assert.AreEqual( new Vector3(100.0f, 0.5f, 100.0f), midLeftRight, "Closest point inmidst of line found" ); rightPoint = line.ClosestPointTo(new Vector3(200.0f, 1.0f, 200.0f)); Assert.AreEqual( new Vector3(100.0f, 1.0f, 100.0f), rightPoint, "Closest point on upper end found" ); rightCap = line.ClosestPointTo(new Vector3(200.0f, 3.0f, 200.0f)); Assert.AreEqual( new Vector3(100.0f, 3.0f, 100.0f), rightCap, "Closest point beyond upper end found" ); // Tests whether the closest point determination works on the Z axis line = new Line3(new Vector3(100.0f, 100.0f, 0.0f), Vector3.Backward); leftCap = line.ClosestPointTo(new Vector3(200.0f, 200.0f, -2.0f)); Assert.AreEqual( new Vector3(100.0f, 100.0f, -2.0f), leftCap, "Closest point beyond nearest end found" ); leftPoint = line.ClosestPointTo(new Vector3(200.0f, 200.0f, 0.0f)); Assert.AreEqual( new Vector3(100.0f, 100.0f, 0.0f), leftPoint, "Closest point on nearest end found" ); midLeftRight = line.ClosestPointTo(new Vector3(200.0f, 200.0f, 0.5f)); Assert.AreEqual( new Vector3(100.0f, 100.0f, 0.5f), midLeftRight, "Closest point inmidst of line found" ); rightPoint = line.ClosestPointTo(new Vector3(200.0f, 200.0f, 1.0f)); Assert.AreEqual( new Vector3(100.0f, 100.0f, 1.0f), rightPoint, "Closest point on farthest end found" ); rightCap = line.ClosestPointTo(new Vector3(200.0f, 200.0f, 3.0f)); Assert.AreEqual( new Vector3(100.0f, 100.0f, 3.0f), rightCap, "Closest point beyond farthest end found" ); }
public void TestEqualityOperatorAgainstNull() { Line3 line = new Line3(); Assert.IsFalse(line.Equals(null), "Initialized Line is not equal to null"); }
public void TestFindContactsOnOrientedBox() { Volumes.Box3 box = new Volumes.Box3( MatrixHelper.Create( new Vector3(15.0f, 15.0f, 15.0f), Vector3.Normalize(new Vector3(1.0f, -1.0f, -1.0f)), Vector3.Normalize(new Vector3(1.0f, 1.0f, -1.0f)), Vector3.Normalize(new Vector3(1.0f, 1.0f, 1.0f)) ), new Vector3(5.0f, 5.0f, 5.0f) ); float boxRadius = (float)Math.Sqrt(5 * 5 + 5 * 5 + 5 * 5); float outRadius = boxRadius + Specifications.HullAccuracy; float[] contacts = new Line3(new Vector3(0.0f, 15.0f, 15.0f), Vector3.Right).FindContacts(box); Assert.AreEqual( 15.0f - boxRadius, contacts[0], Specifications.MaximumDeviation, "Contact locations on box for X sweep found" ); Assert.AreEqual( 15.0f + boxRadius, contacts[1], Specifications.MaximumDeviation, "Contact locations on box for X sweep found" ); Assert.IsNull( new Line3(new Vector3(0.0f, 15.0f - outRadius, 15.0f), Vector3.Right).FindContacts(box), "Close miss of box on Y axis properly handled" ); Assert.IsNull( new Line3(new Vector3(0.0f, 15.0f + outRadius, 15.0f), Vector3.Right).FindContacts(box), "Close miss of box on Y axis properly handled" ); Assert.IsNull( new Line3(new Vector3(0.0f, 15.0f, 15.0f - outRadius), Vector3.Right).FindContacts(box), "Close miss of box on Z axis properly handled" ); Assert.IsNull( new Line3(new Vector3(0.0f, 15.0f, 15.0f + outRadius), Vector3.Right).FindContacts(box), "Close miss of box on Z axis properly handled" ); contacts = new Line3(new Vector3(15.0f, 0.0f, 15.0f), Vector3.Up).FindContacts(box); Assert.AreEqual( 15.0f - boxRadius, contacts[0], Specifications.MaximumDeviation, "Contact locations on box for Y sweep found" ); Assert.AreEqual( 15.0f + boxRadius, contacts[1], Specifications.MaximumDeviation, "Contact locations on box for Y sweep found" ); Assert.IsNull( new Line3(new Vector3(15.0f - outRadius, 0.0f, 15.0f), Vector3.Up).FindContacts(box), "Close miss of box on X axis properly handled" ); Assert.IsNull( new Line3(new Vector3(15.0f + outRadius, 0.0f, 15.0f), Vector3.Up).FindContacts(box), "Close miss of box on X axis properly handled" ); Assert.IsNull( new Line3(new Vector3(15.0f, 0.0f, 15.0f - outRadius), Vector3.Up).FindContacts(box), "Close miss of box on Z axis properly handled" ); Assert.IsNull( new Line3(new Vector3(15.0f, 0.0f, 15.0f + outRadius), Vector3.Up).FindContacts(box), "Close miss of box on Z axis properly handled" ); contacts = new Line3(new Vector3(15.0f, 15.0f, 0.0f), Vector3.Backward).FindContacts(box); Assert.AreEqual( 15.0f - boxRadius, contacts[0], Specifications.MaximumDeviation, "Contact locations on box for Z sweep found" ); Assert.AreEqual( 15.0f + boxRadius, contacts[1], Specifications.MaximumDeviation, "Contact locations on box for Z sweep found" ); Assert.IsNull( new Line3(new Vector3(15.0f - outRadius, 15.0f, 0.0f), Vector3.Backward).FindContacts(box), "Close miss of box on X axis properly handled" ); Assert.IsNull( new Line3(new Vector3(15.0f + outRadius, 15.0f, 0.0f), Vector3.Backward).FindContacts(box), "Close miss of box on X axis properly handled" ); Assert.IsNull( new Line3(new Vector3(15.0f, 15.0f - outRadius, 0.0f), Vector3.Backward).FindContacts(box), "Close miss of box on Y axis properly handled" ); Assert.IsNull( new Line3(new Vector3(15.0f, 15.0f + outRadius, 0.0f), Vector3.Backward).FindContacts(box), "Close miss of box on Y axis properly handled" ); }
public void TestClosestPoint() { // Test whether the closest point determination works on the X axis Line3 line = new Line3(new Vector3(0.0f, 100.0f, 100.0f), Vector3.Right); Vector3 leftCap = line.ClosestPointTo(new Vector3(-2.0f, 200.0f, 200.0f)); Assert.AreEqual( new Vector3(-2.0f, 100.0f, 100.0f), leftCap, "Closest point beyond left end found" ); Vector3 leftPoint = line.ClosestPointTo(new Vector3(0.0f, 200.0f, 200.0f)); Assert.AreEqual( new Vector3(0.0f, 100.0f, 100.0f), leftPoint, "Closest point on left end found" ); Vector3 midLeftRight = line.ClosestPointTo(new Vector3(0.5f, 200.0f, 200.0f)); Assert.AreEqual( new Vector3(0.5f, 100.0f, 100.0f), midLeftRight, "Closest point inmidst of line found" ); Vector3 rightPoint = line.ClosestPointTo(new Vector3(1.0f, 200.0f, 200.0f)); Assert.AreEqual( new Vector3(1.0f, 100.0f, 100.0f), rightPoint, "Closest point on right end found" ); Vector3 rightCap = line.ClosestPointTo(new Vector3(3.0f, 200.0f, 200.0f)); Assert.AreEqual( new Vector3(3.0f, 100.0f, 100.0f), rightCap, "Closest point beyond right end found" ); // Test whether the closest point determination works on the Y axis line = new Line3(new Vector3(100.0f, 0.0f, 100.0f), Vector3.Up); leftCap = line.ClosestPointTo(new Vector3(200.0f, -2.0f, 200.0f)); Assert.AreEqual( new Vector3(100.0f, -2.0f, 100.0f), leftCap, "Closest point beyond lower end found" ); leftPoint = line.ClosestPointTo(new Vector3(200.0f, 0.0f, 200.0f)); Assert.AreEqual( new Vector3(100.0f, 0.0f, 100.0f), leftPoint, "Closest point on lower end found" ); midLeftRight = line.ClosestPointTo(new Vector3(200.0f, 0.5f, 200.0f)); Assert.AreEqual( new Vector3(100.0f, 0.5f, 100.0f), midLeftRight, "Closest point inmidst of line found" ); rightPoint = line.ClosestPointTo(new Vector3(200.0f, 1.0f, 200.0f)); Assert.AreEqual( new Vector3(100.0f, 1.0f, 100.0f), rightPoint, "Closest point on upper end found" ); rightCap = line.ClosestPointTo(new Vector3(200.0f, 3.0f, 200.0f)); Assert.AreEqual( new Vector3(100.0f, 3.0f, 100.0f), rightCap, "Closest point beyond upper end found" ); // Tests whether the closest point determination works on the Z axis line = new Line3(new Vector3(100.0f, 100.0f, 0.0f), Vector3.Backward); leftCap = line.ClosestPointTo(new Vector3(200.0f, 200.0f, -2.0f)); Assert.AreEqual( new Vector3(100.0f, 100.0f, -2.0f), leftCap, "Closest point beyond nearest end found" ); leftPoint = line.ClosestPointTo(new Vector3(200.0f, 200.0f, 0.0f)); Assert.AreEqual( new Vector3(100.0f, 100.0f, 0.0f), leftPoint, "Closest point on nearest end found" ); midLeftRight = line.ClosestPointTo(new Vector3(200.0f, 200.0f, 0.5f)); Assert.AreEqual( new Vector3(100.0f, 100.0f, 0.5f), midLeftRight, "Closest point inmidst of line found" ); rightPoint = line.ClosestPointTo(new Vector3(200.0f, 200.0f, 1.0f)); Assert.AreEqual( new Vector3(100.0f, 100.0f, 1.0f), rightPoint, "Closest point on farthest end found" ); rightCap = line.ClosestPointTo(new Vector3(200.0f, 200.0f, 3.0f)); Assert.AreEqual( new Vector3(100.0f, 100.0f, 3.0f), rightCap, "Closest point beyond farthest end found" ); }
public void TestEqualityOperatorAgainstNull() { Line3 line = new Line3(); Assert.IsFalse(line.Equals(null), "Initialized Line is not equal to null"); }
public void TestSerialization() { XmlSerializer serializer = new XmlSerializer(typeof(Line3)); System.IO.MemoryStream stream = new System.IO.MemoryStream(); Line3 line = new Line3( new Vector3(123.0f, 456.0f, 789.0f), new Vector3(987.0f, 654.0f, 321.0f) ); serializer.Serialize(stream, line); stream.Seek(0, System.IO.SeekOrigin.Begin); Line3 restored = (Line3)serializer.Deserialize(stream); Assert.AreEqual(line, restored, "Deserialized line matches serialized line"); }
public void TestFindSideContactsOnTriangle() { Areas.Triangle3 triangle = new Areas.Triangle3( new Vector3(10.0f, 10.0f, 15.0f), new Vector3(20.0f, 10.0f, 15.0f), new Vector3(15.0f, 20.0f, 15.0f) ); LineContacts contacts = new Line3( new Vector3(15.0f, 15.0f, 0.0f), Vector3.Backward ).FindContacts(triangle); Assert.AreEqual( 15.0f, contacts.EntryTime, "Direct orthogonal contact to triangle detected" ); contacts = new Line3( new Vector3(15.0f, 15.0f, 30.0f), -Vector3.Backward ).FindContacts(triangle); Assert.AreEqual( 15.0f, contacts.EntryTime, "Direct orthogonal contact to triangle backside detected" ); contacts = new Line3( new Vector3(15.0f, 5.0f, 0.0f), Vector3.Backward ).FindContacts(triangle); Assert.IsNaN( contacts.EntryTime, "Side A->B miss of triangle plane correctly filtered out" ); contacts = new Line3( new Vector3(10.0f, 15.0f, 0.0f), Vector3.Backward ).FindContacts(triangle); Assert.IsNaN( contacts.EntryTime, "Side A->C miss of triangle plane correctly filtered out" ); contacts = new Line3( new Vector3(20.0f, 15.0f, 0.0f), Vector3.Backward ).FindContacts(triangle); Assert.IsNaN( contacts.EntryTime, "Side B->C miss of triangle plane correctly filtered out" ); }
public void TestFindOrthogonalContactsOnTriangle() { Areas.Triangle3 triangle = new Areas.Triangle3( new Vector3(10.0f, 10.0f, 15.0f), new Vector3(20.0f, 10.0f, 15.0f), new Vector3(15.0f, 20.0f, 15.0f) ); LineContacts contacts = new Line3( new Vector3(15.0f, 15.0f, 0.0f), Vector3.Backward ).FindContacts(triangle); Assert.AreEqual( 15.0f, contacts.EntryTime, "Direct orthogonal contact to triangle detected" ); contacts = new Line3( new Vector3(15.0f, 15.0f, 30.0f), -Vector3.Backward ).FindContacts(triangle); Assert.AreEqual( 15.0f, contacts.EntryTime, "Direct orthogonal contact to triangle backside detected" ); }
public void TestFindContactsOnPlane() { Areas.Plane3 plane = new Areas.Plane3( new Vector3(15.0f, 15.0f, 15.0f), -Vector3.Backward ); LineContacts contacts = new Line3( new Vector3(15.0f, 15.0f, 0.0f), Vector3.Backward ).FindContacts(plane); Assert.AreEqual( 15.0f, contacts.EntryTime, "Direct orthogonal contact to plane detected" ); contacts = new Line3( new Vector3(15.0f, 15.0f, 30.0f), -Vector3.Backward ).FindContacts(plane); Assert.AreEqual( 15.0f, contacts.EntryTime, "Direct orthogonal contact to plane from backside detected" ); }
public void TestFindContactsOnOrientedBox() { Volumes.Box3 box = new Volumes.Box3( MatrixHelper.Create( new Vector3(15.0f, 15.0f, 15.0f), Vector3.Normalize(new Vector3(1.0f, -1.0f, -1.0f)), Vector3.Normalize(new Vector3(1.0f, 1.0f, -1.0f)), Vector3.Normalize(new Vector3(1.0f, 1.0f, 1.0f)) ), new Vector3(5.0f, 5.0f, 5.0f) ); float boxRadius = (float)Math.Sqrt(5 * 5 + 5 * 5 + 5 * 5); float outRadius = boxRadius + Specifications.HullAccuracy; float[] contacts = new Line3(new Vector3(0.0f, 15.0f, 15.0f), Vector3.Right).FindContacts(box); Assert.AreEqual( 15.0f - boxRadius, contacts[0], Specifications.MaximumDeviation, "Contact locations on box for X sweep found" ); Assert.AreEqual( 15.0f + boxRadius, contacts[1], Specifications.MaximumDeviation, "Contact locations on box for X sweep found" ); Assert.IsNull( new Line3(new Vector3(0.0f, 15.0f - outRadius, 15.0f), Vector3.Right).FindContacts(box), "Close miss of box on Y axis properly handled" ); Assert.IsNull( new Line3(new Vector3(0.0f, 15.0f + outRadius, 15.0f), Vector3.Right).FindContacts(box), "Close miss of box on Y axis properly handled" ); Assert.IsNull( new Line3(new Vector3(0.0f, 15.0f, 15.0f - outRadius), Vector3.Right).FindContacts(box), "Close miss of box on Z axis properly handled" ); Assert.IsNull( new Line3(new Vector3(0.0f, 15.0f, 15.0f + outRadius), Vector3.Right).FindContacts(box), "Close miss of box on Z axis properly handled" ); contacts = new Line3(new Vector3(15.0f, 0.0f, 15.0f), Vector3.Up).FindContacts(box); Assert.AreEqual( 15.0f - boxRadius, contacts[0], Specifications.MaximumDeviation, "Contact locations on box for Y sweep found" ); Assert.AreEqual( 15.0f + boxRadius, contacts[1], Specifications.MaximumDeviation, "Contact locations on box for Y sweep found" ); Assert.IsNull( new Line3(new Vector3(15.0f - outRadius, 0.0f, 15.0f), Vector3.Up).FindContacts(box), "Close miss of box on X axis properly handled" ); Assert.IsNull( new Line3(new Vector3(15.0f + outRadius, 0.0f, 15.0f), Vector3.Up).FindContacts(box), "Close miss of box on X axis properly handled" ); Assert.IsNull( new Line3(new Vector3(15.0f, 0.0f, 15.0f - outRadius), Vector3.Up).FindContacts(box), "Close miss of box on Z axis properly handled" ); Assert.IsNull( new Line3(new Vector3(15.0f, 0.0f, 15.0f + outRadius), Vector3.Up).FindContacts(box), "Close miss of box on Z axis properly handled" ); contacts = new Line3(new Vector3(15.0f, 15.0f, 0.0f), Vector3.Backward).FindContacts(box); Assert.AreEqual( 15.0f - boxRadius, contacts[0], Specifications.MaximumDeviation, "Contact locations on box for Z sweep found" ); Assert.AreEqual( 15.0f + boxRadius, contacts[1], Specifications.MaximumDeviation, "Contact locations on box for Z sweep found" ); Assert.IsNull( new Line3(new Vector3(15.0f - outRadius, 15.0f, 0.0f), Vector3.Backward).FindContacts(box), "Close miss of box on X axis properly handled" ); Assert.IsNull( new Line3(new Vector3(15.0f + outRadius, 15.0f, 0.0f), Vector3.Backward).FindContacts(box), "Close miss of box on X axis properly handled" ); Assert.IsNull( new Line3(new Vector3(15.0f, 15.0f - outRadius, 0.0f), Vector3.Backward).FindContacts(box), "Close miss of box on Y axis properly handled" ); Assert.IsNull( new Line3(new Vector3(15.0f, 15.0f + outRadius, 0.0f), Vector3.Backward).FindContacts(box), "Close miss of box on Y axis properly handled" ); }
/// <summary>Checks whether another instance is equal to this instance</summary> /// <param name="other">Other instance to compare to this instance</param> /// <returns>True if the other instance is equal to this instance</returns> public virtual bool Equals(Line3 other) { if(other == null) return false; else return (this.Offset == other.Offset) && (this.Direction == other.Direction); }
public Line3(Line3 other) { Offset = other.Offset; Direction = other.Direction; }
public Line3(Line3 other) { Offset = other.Offset; Direction = other.Direction; }