Esempio n. 1
0
        public void Angle()
        {
            var p1 = new Ax2(new Pnt(1, 2, 3), new Dir(1, 0, 0));
            var p2 = new Ax2(new Pnt(2, 3, 4), new Dir(0, 1, 0));

            Assert.AreEqual(Math.PI / 2, p1.Angle(p2));
        }
Esempio n. 2
0
        public void MirrorPnt()
        {
            var res = new Ax2(new Pnt(1, -2, -3), new Dir(1, 0, 0), new Dir(0, 0, -1));
            var p2  = new Ax2(new Pnt(1, 2, 3), new Dir(1, 0, 0));

            Assert.AreEqual(res, p2.Mirrored(new Pnt(1, 0, 0)));
            p2.Mirror(new Pnt(1, 0, 0));
            Assert.AreEqual(res, p2);
        }
Esempio n. 3
0
        public void MirrorAx2()
        {
            var a2 = new Ax2(new Pnt(-1, 2, -3), new Dir(-1, 0, 0));
            var p2 = new Pnt(2, 1, 3);

            Assert.AreEqual(new Pnt(-4, 1, 3), p2.Mirrored(a2));
            p2.Mirror(a2);
            Assert.AreEqual(new Pnt(-4, 1, 3), p2);
        }
Esempio n. 4
0
        public void MirrorAx2()
        {
            var a2 = new Ax2(new Pnt(-1, 2, -3), new Dir(-1, 0, 0));
            var p2 = new Vec(2, 1, 3);

            Assert.That(new Vec(-2, 1, 3).IsEqual(p2.Mirrored(a2), 0.000001, 0.0001));
            p2.Mirror(a2);
            Assert.That(new Vec(-2, 1, 3).IsEqual(p2, 0.000001, 0.0001));
        }
Esempio n. 5
0
        public void TranslateVec()
        {
            var res = new Ax2(new Pnt(3, 5, 4), new Dir(1, 0, 0));
            var p2  = new Ax2(new Pnt(1, 2, 3), new Dir(1, 0, 0));

            Assert.AreEqual(res, p2.Translated(new Vec(2, 3, 1)));
            p2.Translate(new Vec(2, 3, 1));
            Assert.AreEqual(res, p2);
        }
Esempio n. 6
0
        public void Scale()
        {
            var res = new Ax2(new Pnt(-1, 0, 5), new Dir(1, 0, 0));
            var p2  = new Ax2(new Pnt(1, 2, 3), new Dir(1, 0, 0));

            Assert.AreEqual(res, p2.Scaled(new Pnt(2, 3, 2), 3));
            p2.Scale(new Pnt(2, 3, 2), 3);
            Assert.AreEqual(res, p2);
        }
Esempio n. 7
0
        public void MirrorAx2()
        {
            var a2 = new Ax2(new Pnt(-1, 2, -3), new Dir(-1, 0, 0));
            var p1 = new Dir(1, 0, 0);

            Assert.AreEqual(new Dir(-1, 0, 0), p1.Mirrored(a2));
            p1.Mirror(a2);
            Assert.AreEqual(new Dir(-1, 0, 0), p1);
        }
Esempio n. 8
0
        public void Rotate()
        {
            var res = new Ax2(new Pnt(1, 1, 2), new Dir(1, 0, 0), new Dir(0, -1, 0));
            var a1  = new Ax1(new Pnt(2, 2, 2), new Dir(1, 0, 0));
            var p2  = new Ax2(new Pnt(1, 2, 3), new Dir(1, 0, 0));

            Assert.IsTrue(res.IsCoplanar(p2.Rotated(a1, Math.PI / 2), 0, 0));
            p2.Rotate(a1, Math.PI / 2);
            Assert.IsTrue(res.IsCoplanar(p2, 0, 0));
        }
Esempio n. 9
0
        public void IsCoplanar()
        {
            var p1 = new Ax2(new Pnt(1, 2, 3), new Dir(1, 0, 0));
            var p2 = new Ax2(new Pnt(2, 3, 4), new Dir(0, 1, 0));

            Assert.IsFalse(p1.IsCoplanar(p2, 0.1, 0.1));
            Assert.IsFalse(p1.IsCoplanar(p2, 0.1, 2.0));
            Assert.IsFalse(p1.IsCoplanar(p2, 0.1, Math.PI / 2));
            Assert.IsTrue(p1.IsCoplanar(p2, 1.0, Math.PI / 2));
        }
Esempio n. 10
0
        public void MirrorAx2()
        {
            var res = new Ax2(new Pnt(1, -2, 3), new Dir(-1, 0, 0), new Dir(0, 0, 1));
            var a2  = new Ax2(new Pnt(1, 0, 0), new Dir(0, 1, 0));
            var p2  = new Ax2(new Pnt(1, 2, 3), new Dir(1, 0, 0));

            Assert.AreEqual(res, p2.Mirrored(a2));
            p2.Mirror(a2);
            Assert.AreEqual(res, p2);
        }
Esempio n. 11
0
        public void MirrorAx2()
        {
            var a2 = new Ax2(new Pnt(-1, 2, -3), new Dir(-1, 0, 0));
            var p2 = new Ax1(new Pnt(1, 2, 3), new Dir(1, 0, 0));

            Assert.That(new Pnt(-3, 2, 3).IsEqual(p2.Mirrored(a2).Location, 0.0000001));
            Assert.That(new Dir(-1, 0, 0).IsEqual(p2.Mirrored(a2).Direction, 0.0000001));
            p2.Mirror(a2);
            Assert.That(new Pnt(-3, 2, 3).IsEqual(p2.Location, 0.0000001));
            Assert.That(new Dir(-1, 0, 0).IsEqual(p2.Direction, 0.0000001));
        }
Esempio n. 12
0
        public void Transform()
        {
            Trsf t1 = new Trsf();

            t1.SetRotation(Ax1.OZ, Math.PI / 2);
            var p2 = new Ax2(new Pnt(1, 2, 3), new Dir(1, 0, 0));
            var p3 = p2.Transformed(t1);

            Assert.That(new Pnt(-2, 1, 3).IsEqual(p3.Location, 0.0000001));
            Assert.That(new Dir(0, 0, 1).IsEqual(p3.XDirection, 0.0000001));
            Assert.That(new Dir(1, 0, 0).IsEqual(p3.YDirection, 0.0000001));
            Assert.That(new Dir(0, 1, 0).IsEqual(p3.Direction, 0.0000001));
            p2.Transform(t1);
            Assert.That(new Pnt(-2, 1, 3).IsEqual(p2.Location, 0.0000001));
            Assert.That(new Dir(0, 0, 1).IsEqual(p2.XDirection, 0.0000001));
            Assert.That(new Dir(1, 0, 0).IsEqual(p2.YDirection, 0.0000001));
            Assert.That(new Dir(0, 1, 0).IsEqual(p2.Direction, 0.0000001));
        }
Esempio n. 13
0
        public void Components()
        {
            var p1 = new Ax2(new Pnt(1, 2, 3), new Dir(1, 0, 0));

            Assert.AreEqual(new Pnt(1, 2, 3), p1.Location);
            Assert.AreEqual(new Dir(1, 0, 0), p1.Direction);
            Assert.AreEqual(new Dir(0, 0, 1), p1.XDirection);
            Assert.AreEqual(new Dir(0, -1, 0), p1.YDirection);

            p1.Location = new Pnt(3, 2, 1);
            Assert.AreEqual(new Pnt(3, 2, 1), p1.Location);
            p1.Direction = new Dir(0, 1, 0);
            Assert.AreEqual(new Dir(0, 1, 0), p1.Direction);
            p1.XDirection = new Dir(0, 0, -1);
            Assert.AreEqual(new Dir(0, 0, -1), p1.XDirection);
            p1.YDirection = new Dir(1, 0, 0);
            Assert.AreEqual(new Dir(1, 0, 0), p1.YDirection);
        }
        public void ValueType_Ax3()
        {
            var s1 = new Ax3(new Pnt(1, 2, 3), new Dir(1, 0, 0));
            var s2 = new Ax3(new Pnt(2, 3, 4), new Dir(0, 1, 0));

            Assert.AreEqual(new Pnt(1, 2, 3), s1.Location);
            Assert.AreEqual(new Dir(1, 0, 0), s1.Direction);
            Assert.AreEqual(new Dir(0, 0, 1), s1.XDirection);
            Assert.AreEqual(new Dir(0, -1, 0), s1.YDirection);

            var p2 = s2;

            Assert.IsFalse(s1.IsCoplanar(p2, 0.1, 0.1));
            Assert.IsFalse(s1.IsCoplanar(p2, 0.1, 2.0));
            Assert.IsFalse(s1.IsCoplanar(p2, 0.1, Math.PI / 2));
            Assert.IsTrue(s1.IsCoplanar(p2, 1.0, Math.PI / 2));
            Assert.AreEqual(Math.PI / 2, s1.Angle(p2));

            p2.Location = new Pnt(3, 2, 1);
            Assert.AreEqual(new Pnt(3, 2, 1), p2.Location);
            p2.Direction = new Dir(0, 1, 0);
            Assert.AreEqual(new Dir(0, 1, 0), p2.Direction);
            p2.XDirection = new Dir(0, 0, -1);
            Assert.AreEqual(new Dir(0, 0, -1), p2.XDirection);
            p2.YDirection = new Dir(1, 0, 0);
            Assert.AreEqual(new Dir(1, 0, 0), p2.YDirection);

            p2.XReverse();
            Assert.AreEqual(new Dir(0, 0, -1), p2.XDirection);
            p2.YReverse();
            Assert.AreEqual(new Dir(-1, 0, 0), p2.YDirection);
            p2.ZReverse();
            Assert.AreEqual(new Dir(0, -1, 0), p2.Direction);

            Assert.IsFalse(p2.Direct());

            var res = new Ax3(new Pnt(1, -2, -3), new Dir(-1, 0, 0), new Dir(0, 0, -1));

            res.YReverse();
            p2 = s1;
            Assert.AreEqual(res, p2.Mirrored(new Pnt(1, 0, 0)));
            p2.Mirror(new Pnt(1, 0, 0));
            Assert.AreEqual(res, p2);

            res = new Ax3(new Pnt(1, -2, 3), new Dir(1, 0, 0), new Dir(0, 0, 1));
            res.YReverse();
            var a2 = new Ax2(new Pnt(1, 0, 0), new Dir(0, 1, 0));

            p2 = s1;
            Assert.AreEqual(res, p2.Mirrored(a2));
            p2.Mirror(a2);
            Assert.AreEqual(res, p2);

            res = new Ax3(new Pnt(1, -2, -3), new Dir(1, 0, 0), new Dir(0, 0, -10));
            var a1 = new Ax1(new Pnt(1, 0, 0), new Dir(1, 0, 0));

            p2 = s1;
            Assert.AreEqual(res, p2.Mirrored(a1));
            p2.Mirror(a1);
            Assert.AreEqual(res, p2);

            res = new Ax3(new Pnt(1, 1, 2), new Dir(1, 0, 0), new Dir(0, -1, 0));
            a1  = new Ax1(new Pnt(2, 2, 2), new Dir(1, 0, 0));
            Assert.IsTrue(res.IsCoplanar(s1.Rotated(a1, Math.PI / 2), 0, 0));
            p2 = s1;
            p2.Rotate(a1, Math.PI / 2);
            Assert.IsTrue(res.IsCoplanar(p2, 0, 0));

            res = new Ax3(new Pnt(-1, 0, 5), new Dir(1, 0, 0));
            p2  = s1;
            Assert.AreEqual(res, p2.Scaled(new Pnt(2, 3, 2), 3));
            p2.Scale(new Pnt(2, 3, 2), 3);
            Assert.AreEqual(res, p2);

            res = new Ax3(new Pnt(-1, -1, 2), new Dir(1, 0, 0));
            p2  = s1;
            Assert.AreEqual(res, p2.Translated(new Pnt(3, 5, 4), new Pnt(1, 2, 3)));
            p2.Translate(new Pnt(3, 5, 4), new Pnt(1, 2, 3));
            Assert.AreEqual(res, p2);

            res = new Ax3(new Pnt(3, 5, 4), new Dir(1, 0, 0));
            p2  = s1;
            Assert.AreEqual(res, p2.Translated(new Vec(2, 3, 1)));
            p2.Translate(new Vec(2, 3, 1));
            Assert.AreEqual(res, p2);

            //gp_Trsf gt1 = new gp_Trsf();
            //gt1.SetRotation(gp.OZ(), Math.PI / 2);
            //gp2.Transform(gt1);
            //TestContext.WriteLine(string.Format(CultureInfo.InvariantCulture, $"({gp2.Location().x},{gp2.Location().y},{gp2.Location().z}),({gp2.XDirection().x},{gp2.XDirection().y},{gp2.XDirection().z}),({gp2.YDirection().x},{gp2.YDirection().y},{gp2.YDirection().z}),({gp2.Direction().x},{gp2.Direction().y},{gp2.Direction().z})"));

            Trsf t1 = new Trsf();

            t1.SetRotation(Ax1.OZ, Math.PI / 2);
            p2 = s1;
            Assert.AreEqual("(-2,1,3),(0,0,1),(1,-1.11022302462516E-16,0),(1.11022302462516E-16,1,0)", p2.Transformed(t1).ToString());
            p2.Transform(t1);
            Assert.AreEqual("(-2,1,3),(0,0,1),(1,-1.11022302462516E-16,0),(1.11022302462516E-16,1,0)", p2.ToString());
        }
        public void ValueType_Ax1()
        {
            Assert.AreEqual(new Ax1(Pnt.Origin, Dir.DX), Ax1.OX);
            Assert.AreEqual(new Ax1(Pnt.Origin, Dir.DY), Ax1.OY);
            Assert.AreEqual(new Ax1(Pnt.Origin, Dir.DZ), Ax1.OZ);

            var s1 = new Ax1(new Pnt(1, 2, 3), new Dir(1, 0, 0));
            var s2 = new Ax1(new Pnt(2, 3, 4), new Dir(0, 1, 0));
            var p1 = s1;
            var p2 = s2;

            Assert.IsFalse(p1.IsCoaxial(p2, 0.1, 0.1));
            Assert.IsFalse(p1.IsCoaxial(p2, Math.PI / 2, 0.1));
            Assert.IsTrue(p1.IsCoaxial(p2, Math.PI / 2, 2.0));
            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));

            Assert.AreEqual(Math.PI / 2, p1.Angle(p2));

            var m1 = new Ax1(new Pnt(1, 2, 3), new Dir(-1, 0, 0));

            p2 = s1;
            p2.Reverse();
            Assert.AreEqual(m1, p2);
            Assert.AreEqual(m1, p1.Reversed());

            m1 = new Ax1(new Pnt(-1, 0, -3), new Dir(-1, 0, 0));
            p2 = s1;
            p2.Mirror(new Pnt(0, 1, 0));
            Assert.AreEqual(m1, p2);
            Assert.AreEqual(m1, p1.Mirrored(new Pnt(0, 1, 0)));

            m1 = new Ax1(new Pnt(-1, 2, -3), new Dir(-1, 0, 0));
            var m2 = new Ax1(new Pnt(0, 1, 0), new Dir(0, 1, 0));

            p2 = s1;
            p2.Mirror(m2);
            Assert.AreEqual(m1, p2);
            Assert.AreEqual(m1, p1.Mirrored(m2));

            m1 = new Ax1(new Pnt(3, 2, -1), new Dir(0, 0, -1));
            p2 = s1;
            p2.Rotate(m2, Math.PI / 2);
            Assert.IsTrue(m1.IsCoaxial(p2, 0.0001, 0.001));
            Assert.IsTrue(m1.IsCoaxial(p1.Rotated(m2, Math.PI / 2), 0.0001, 0.001));

            m1 = new Ax1(new Pnt(-1, 0, 5), new Dir(1, 0, 0));
            p2 = s1;
            p2.Scale(new Pnt(2, 3, 2), 3);
            Assert.AreEqual(m1, p2);
            Assert.AreEqual(m1, p1.Scaled(new Pnt(2, 3, 2), 3));

            m1 = new Ax1(new Pnt(-1, -1, 2), new Dir(1, 0, 0));
            p2 = s1;
            p2.Translate(new Pnt(3, 5, 4), new Pnt(1, 2, 3));
            Assert.AreEqual(m1, p2);
            Assert.AreEqual(m1, p1.Translated(new Pnt(3, 5, 4), new Pnt(1, 2, 3)));

            m1 = new Ax1(new Pnt(3, 5, 4), new Dir(1, 0, 0));
            p2 = s1;
            p2.Translate(new Vec(2, 3, 1));
            Assert.AreEqual(m1, p2);
            Assert.AreEqual(m1, p1.Translated(new Vec(2, 3, 1)));

            //            TestContext.WriteLine(string.Format(CultureInfo.InvariantCulture, $"{gp2.Location().x},{gp2.Location().y},{gp2.Location().z} - {gp2.Direction().x},{gp2.Direction().y},{gp2.Direction().z}"));

            Trsf t1 = new Trsf();

            t1.SetRotation(Ax1.OZ, Math.PI / 2);
            p2 = s1;
            Assert.AreEqual("(-2,1,3),(1.11022302462516E-16,1,0)", p2.Transformed(t1).ToString());
            p2.Transform(t1);
            Assert.AreEqual("(-2,1,3),(1.11022302462516E-16,1,0)", p2.ToString());

            var a2 = new Ax2(new Pnt(-1, 2, -3), new Dir(-1, 0, 0));

            p2 = new Ax1(new Pnt(1, 2, 3), new Dir(1, 0, 0));
            Assert.AreEqual("(-3,2,3),(-1,0,0)", p2.Mirrored(a2).ToString());
            p2.Mirror(a2);
            Assert.AreEqual("(-3,2,3),(-1,0,0)", p2.ToString());
        }
        public void ValueType_Dir()
        {
            Assert.AreEqual(new Dir(1, 0, 0), Dir.DX);
            Assert.AreEqual(new Dir(0, 1, 0), Dir.DY);
            Assert.AreEqual(new Dir(0, 0, 1), Dir.DZ);

            var p1 = new Dir(1, 0, 0);
            var p2 = new Dir(0, 1, 0);

            Assert.IsFalse(p1.IsEqual(p2, 0.1));
            Assert.IsTrue(p1.IsEqual(p2, 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));

            Assert.AreEqual(Math.PI / 2, p1.Angle(p2));
            Assert.AreEqual(Math.PI / 2, p1.AngleWithRef(p2, new Dir(0, 0, 1)));

            p2 = new Dir(1, 0, 0);
            p2.Cross(new Dir(0, 1, 0));
            Assert.AreEqual(new Dir(0, 0, 1), p2);
            Assert.AreEqual(new Dir(0, 0, 1), p1.Crossed(new Dir(0, 1, 0)));

            p2 = new Dir(1, 0, 0);
            p2.CrossCross(new Dir(0, 1, 0), new Dir(1, 0, 1));
            Assert.AreEqual(new Dir(0, 1, 0), p2);
            Assert.AreEqual(new Dir(0, 1, 0), p1.CrossCrossed(new Dir(0, 1, 0), new Dir(1, 0, 1)));

            Assert.AreEqual(Math.Sqrt(2) / 2, p1.Dot(new Dir(1, 1, 0)), 0.0000001);
            Assert.AreEqual(Math.Sqrt(2) / 2, p1.DotCross(new Dir(0, 1, 0), new Dir(1, 0, 1)), 0.0000001);

            p2 = new Dir(1, 0, 0);
            p2.Reverse();
            Assert.AreEqual(new Dir(-1, 0, 0), p2);
            Assert.AreEqual(new Dir(-1, 0, 0), p1.Reversed());

            p2 = new Dir(1, 0, 0);
            p2.Mirror(new Dir(0, 1, 0));
            Assert.AreEqual(new Dir(-1, 0, 0), p2);
            Assert.AreEqual(new Dir(-1, 0, 0), p1.Mirrored(new Dir(0, 1, 0)));

            var m2 = new Ax1(new Pnt(-1, 2, -3), new Dir(-1, 0, 0));

            p2 = new Dir(1, 0, 0);
            p2.Mirror(m2);
            Assert.AreEqual(new Dir(1, 0, 0), p2);
            Assert.AreEqual(new Dir(1, 0, 0), p1.Mirrored(m2));

            var a2 = new Ax2(new Pnt(-1, 2, -3), new Dir(-1, 0, 0));

            p2 = new Dir(1, 0, 0);
            Assert.AreEqual(new Dir(-1, 0, 0), p2.Mirrored(a2));
            p2.Mirror(a2);
            Assert.AreEqual(new Dir(-1, 0, 0), p2);

            p2 = new Dir(1, 0, 0);
            p2.Rotate(m2, Math.PI / 2);
            Assert.AreEqual(new Dir(1, 0, 0), p2);
            Assert.AreEqual(new Dir(1, 0, 0), p1.Rotated(m2, Math.PI / 2));

            //TestContext.WriteLine(string.Format(CultureInfo.InvariantCulture, "{0},{1},{2}", gp2.x, gp2.y, gp2.z));

            Trsf t1 = new Trsf();

            t1.SetRotation(Ax1.OZ, Math.PI / 2);
            p2 = new Dir(0, 1, 0);
            Assert.AreEqual("-1,1.11022302462516E-16,0", p2.Transformed(t1).ToString());
            p2.Transform(t1);
            Assert.AreEqual("-1,1.11022302462516E-16,0", p2.ToString());
        }
        public void ValueType_Vec()
        {
            var p1 = new Vec(1, 0, 0);
            var p2 = new Vec(0, 1, 0);

            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 Vec(1, 2, 3);
            p2 = new Vec(4, 5, 6);

            Assert.AreEqual(14, p1.SquareMagnitude());
            Assert.AreEqual(Math.Sqrt(14), p1.Magnitude());

            p2 = p1;
            p2.Add(new Vec(1, 2, 3));
            Assert.AreEqual(new Vec(2, 4, 6), p2);
            Assert.AreEqual(new Vec(2, 4, 6), p1.Added(new Vec(1, 2, 3)));

            p2 = new Vec(1, 2, 3);
            p2.Subtract(new Vec(3, 2, 1));
            Assert.AreEqual(new Vec(-2, 0, 2), p2);
            Assert.AreEqual(new Vec(-2, 0, 2), p1.Subtracted(new Vec(3, 2, 1)));

            p2 = new Vec(1, 2, 3);
            p2.Cross(new Vec(3, 2, 1));
            Assert.AreEqual(new Vec(-4, 8, -4), p2);
            Assert.AreEqual(new Vec(-4, 8, -4), p1.Crossed(new Vec(3, 2, 1)));

            Assert.AreEqual(Math.Sqrt(96), p1.CrossMagnitude(new Vec(3, 2, 1)));
            Assert.AreEqual(96, p1.CrossSquareMagnitude(new Vec(3, 2, 1)));

            p2 = new Vec(1, 2, 3);
            p2.CrossCross(new Vec(1, 2, 3), new Vec(4, 5, 6));
            Assert.AreEqual(new Vec(-24, -6, 12), p2);
            Assert.AreEqual(new Vec(-24, -6, 12), p1.CrossCrossed(new Vec(1, 2, 3), new Vec(4, 5, 6)));

            p2 = new Vec(1, 2, 3);
            p2.Divide(2);
            Assert.AreEqual(new Vec(0.5, 1, 1.5), p2);
            Assert.AreEqual(new Vec(0.5, 1, 1.5), p1.Divided(2));

            Assert.AreEqual(14, p1.Dot(new Vec(1, 2, 3)));
            Assert.AreEqual(0, p1.DotCross(new Vec(4, 5, 6), new Vec(4, 5, 6)));

            p2 = new Vec(1, 2, 3);
            p2.Multiply(2);
            Assert.AreEqual(new Vec(2, 4, 6), p2);
            Assert.AreEqual(new Vec(2, 4, 6), p1.Multiplied(2));

            p2 = new Vec(1, 2, 3);
            p2.Scale(2);
            Assert.AreEqual(new Vec(2, 4, 6), p2);
            Assert.AreEqual(new Vec(2, 4, 6), p1.Scaled(2));

            p2 = new Vec(1, 2, 3);
            p2.Normalize();
            Assert.IsTrue(p2.IsEqual(new Vec(0.26726, 0.53452, 0.80178), 0.00001, 0.00001));
            Assert.IsTrue(p1.Normalized().IsEqual(new Vec(0.26726, 0.53452, 0.80178), 0.00001, 0.00001));

            p2 = new Vec(1, 2, 3);
            p2.Reverse();
            Assert.AreEqual(new Vec(-1, -2, -3), p2);
            Assert.AreEqual(new Vec(-1, -2, -3), p1.Reversed());

            p2.SetLinearForm(new Vec(1, 2, 3), new Vec(4, 5, 6));
            Assert.AreEqual(new Vec(5, 7, 9), p2);
            p2.SetLinearForm(2, new Vec(1, 2, 3), new Vec(4, 5, 6));
            Assert.AreEqual(new Vec(6, 9, 12), p2);
            p2.SetLinearForm(2, new Vec(1, 2, 3), 3, new Vec(4, 5, 6));
            Assert.AreEqual(new Vec(14, 19, 24), p2);
            p2.SetLinearForm(2, new Vec(1, 2, 3), 3, new Vec(4, 5, 6), new Vec(7, 8, 9));
            Assert.AreEqual(new Vec(21, 27, 33), p2);
            p2.SetLinearForm(2, new Vec(1, 2, 3), 3, new Vec(4, 5, 6), 4, new Vec(7, 8, 9));
            Assert.AreEqual(new Vec(42, 51, 60), p2);
            p2.SetLinearForm(2, new Vec(1, 2, 3), 3, new Vec(4, 5, 6), 4, new Vec(7, 8, 9), new Vec(10, 11, 12));
            Assert.AreEqual(new Vec(52, 62, 72), p2);

            p2 = new Vec(2, 0, 0);
            p2.Mirror(new Vec(0, 1, 0));
            Assert.AreEqual(new Vec(-2, 0, 0), p2);
            Assert.AreEqual(new Vec(2, 0, 0), p2.Mirrored(new Vec(0, 1, 0)));

            var m2 = new Ax1(new Pnt(-1, 2, -3), new Dir(-1, 0, 0));

            p2 = new Vec(2, 1, 3);
            Assert.AreEqual(new Vec(2, -1, -3), p2.Mirrored(m2));
            p2.Mirror(m2);
            Assert.AreEqual(new Vec(2, -1, -3), p2);

            var a2 = new Ax2(new Pnt(-1, 2, -3), new Dir(-1, 0, 0));

            p2 = new Vec(2, 1, 3);
            Assert.AreEqual("-2,1,3", p2.Mirrored(a2).ToString());
            p2.Mirror(a2);
            Assert.AreEqual("-2,1,3", p2.ToString());

            p2 = new Vec(2, 1, 3);
            Assert.IsTrue(new Vec(2, 3, -1).IsEqual(p2.Rotated(m2, Math.PI / 2), 0.0001, 0.0001));
            p2.Rotate(m2, Math.PI / 2);
            Assert.IsTrue(new Vec(2, 3, -1).IsEqual(p2, 0.0001, 0.0001));

            //TestContext.WriteLine(string.Format(CultureInfo.InvariantCulture, "{0},{1},{2}", gp2.x, gp2.y, gp2.z));

            Trsf t1 = new Trsf();

            t1.SetRotation(Ax1.OZ, Math.PI / 2);
            p2 = new Vec(4, 5, 6);
            Assert.AreEqual("-5,4,6", p2.Transformed(t1).ToString());
            p2.Transform(t1);
            Assert.AreEqual("-5,4,6", p2.ToString());
        }
        public void ValueType_Pnt()
        {
            var p1 = new Pnt(1, 2, 3);
            var p2 = new Pnt(4, 5, 6);

            Assert.AreEqual(new Pnt(0, 0, 0), Pnt.Origin);

            Assert.AreEqual(27, p1.SquareDistance(p2));
            Assert.AreEqual(Math.Sqrt(27), p1.Distance(p2));

            Assert.IsTrue(p1.IsEqual(p2, 5.2));
            Assert.IsFalse(p1.IsEqual(p2, 5.18));

            p2 = new Pnt(1, 2, 3);
            p2.Mirror(new Pnt(2, 2, 2));
            Assert.AreEqual(new Pnt(3, 2, 1), p2);
            Assert.AreEqual(new Pnt(3, 2, 1), p1.Mirrored(new Pnt(2, 2, 2)));

            p2 = new Pnt(1, 2, 3);
            p2.Translate(new Pnt(2, 2, 2), new Pnt(1, 2, 3));
            Assert.AreEqual(new Pnt(0, 2, 4), p2);
            Assert.AreEqual(new Pnt(0, 2, 4), p1.Translated(new Pnt(2, 2, 2), new Pnt(1, 2, 3)));

            Assert.AreEqual(new XYZ(1, 2, 3), p1.ToXYZ());

            p2 = new Pnt(1, 2, 3);
            p2.Scale(new Pnt(2, 2, 2), 2);
            Assert.AreEqual(new Pnt(0, 2, 4), p2);
            Assert.AreEqual(new Pnt(0, 2, 4), p1.Scaled(new Pnt(2, 2, 2), 2));

            p2.BaryCenter(2, p1, 5);
            Assert.IsTrue(p2.IsEqual(new Pnt(0.71428, 2, 3.28571), 0.00001));

            p2 = new Pnt(1, 2, 3);
            p2.Translate(new Vec(2, 2, 2));
            Assert.AreEqual(new Pnt(3, 4, 5), p2);
            Assert.AreEqual(new Pnt(3, 4, 5), p1.Translated(new Vec(2, 2, 2)));

            p2 = new Pnt(2, 1, 3);
            Assert.AreEqual(new Pnt(4, 4, 7), p2.Translated(new Vec(2, 3, 4)));
            p2.Translate(new Vec(2, 3, 4));
            Assert.AreEqual(new Pnt(4, 4, 7), p2);

            var m2 = new Ax1(new Pnt(-1, 2, -3), new Dir(-1, 0, 0));

            p2 = new Pnt(2, 1, 3);
            Assert.AreEqual(new Pnt(2, 3, -9), p2.Mirrored(m2));
            p2.Mirror(m2);
            Assert.AreEqual(new Pnt(2, 3, -9), p2);

            var a2 = new Ax2(new Pnt(-1, 2, -3), new Dir(-1, 0, 0));

            p2 = new Pnt(2, 1, 3);
            Assert.AreEqual(new Pnt(-4, 1, 3), p2.Mirrored(a2));
            p2.Mirror(a2);
            Assert.AreEqual(new Pnt(-4, 1, 3), p2);

            p2 = new Pnt(2, 1, 3);
            Assert.IsTrue(new Pnt(2, 8, -2).IsEqual(p2.Rotated(m2, Math.PI / 2), 0.0001));
            p2.Rotate(m2, Math.PI / 2);
            Assert.IsTrue(new Pnt(2, 8, -2).IsEqual(p2, 0.0001));

            //TestContext.WriteLine(string.Format(CultureInfo.InvariantCulture, "{0},{1},{2}", gp2.x, gp2.y, gp2.z));

            Trsf t1 = new Trsf();

            t1.SetRotation(Ax1.OZ, Math.PI / 2);
            p2 = new Pnt(4, 5, 6);
            Assert.AreEqual("-5,4,6", p2.Transformed(t1).ToString());
            p2.Transform(t1);
            Assert.AreEqual("-5,4,6", p2.ToString());
        }