1 files changed, 126 insertions, 0 deletions

diff --git a/OpenSim/Region/Environment/Scenes/Tests/SceneObjectTests.cs b/OpenSim/Region/Environment/Scenes/Tests/SceneObjectTests.cs
index c084943..9fad6e6 100644
--- a/OpenSim/Region/Environment/Scenes/Tests/SceneObjectTests.cs
+++ b/OpenSim/Region/Environment/Scenes/Tests/SceneObjectTests.cs
@@ -172,6 +172,132 @@ namespace OpenSim.Region.Environment.Scenes.Tests
             Assert.That(part2.AbsolutePosition == Vector3.Zero);
             
         }
+
+        [Test]
+        public void TestLinkDelink2groups4SceneObjects()
+        {
+            bool debugtest = false;
+
+            Scene scene = SceneTestUtils.SetupScene();
+            SceneObjectPart part1 = SceneTestUtils.AddSceneObject(scene);
+            SceneObjectGroup grp1 = part1.ParentGroup;
+            SceneObjectPart part2 = SceneTestUtils.AddSceneObject(scene);
+            SceneObjectGroup grp2 = part2.ParentGroup;
+            SceneObjectPart part3 = SceneTestUtils.AddSceneObject(scene);
+            SceneObjectGroup grp3 = part3.ParentGroup;
+            SceneObjectPart part4 = SceneTestUtils.AddSceneObject(scene);
+            SceneObjectGroup grp4 = part4.ParentGroup;
+
+
+            grp1.AbsolutePosition = new Vector3(10, 10, 10);
+            grp2.AbsolutePosition = Vector3.Zero;
+            grp3.AbsolutePosition = new Vector3(20, 20, 20);
+            grp4.AbsolutePosition = new Vector3(40, 40, 40);
+
+            // <90,0,0>
+            grp1.Rotation = (Quaternion.CreateFromEulers(90 * Utils.DEG_TO_RAD, 0, 0));
+
+            // <180,0,0>
+            grp2.UpdateGroupRotation(Quaternion.CreateFromEulers(180 * Utils.DEG_TO_RAD, 0, 0));
+
+            // <270,0,0>
+            grp3.Rotation = (Quaternion.CreateFromEulers(270 * Utils.DEG_TO_RAD, 0, 0));
+
+            // <0,90,0>
+            grp4.UpdateGroupRotation(Quaternion.CreateFromEulers(0, 90 * Utils.DEG_TO_RAD, 0));
+
+            // Required for linking
+            grp1.RootPart.UpdateFlag = 0;
+            grp2.RootPart.UpdateFlag = 0;
+            grp3.RootPart.UpdateFlag = 0;
+            grp4.RootPart.UpdateFlag = 0;
+
+            // Link grp2 to grp1.   part2 becomes child prim to grp1. grp2 is eliminated.
+            grp1.LinkToGroup(grp2);
+
+            // Link grp4 to grp3.
+            grp3.LinkToGroup(grp4);
+
+            // Required for linking
+            grp1.RootPart.UpdateFlag = 0;
+            grp3.RootPart.UpdateFlag = 0;
+
+            // At this point we should have 4 parts total in two groups.
+
+            Assert.That(grp1.Children.Count == 2);
+            Assert.That(grp3.Children.Count == 2);
+            
+
+            if (debugtest)
+            {
+                System.Console.WriteLine("--------After Link-------");
+                System.Console.WriteLine("Group1: parts: {0}", grp1.Children.Count);
+                System.Console.WriteLine("Group1: Pos:{0}, Rot:{1}", grp1.AbsolutePosition, grp1.Rotation);
+                System.Console.WriteLine("Group1: Prim1: OffsetPosition:{0}, OffsetRotation:{1}", part1.OffsetPosition, part1.RotationOffset);
+                System.Console.WriteLine("Group1: Prim2: OffsetPosition:{0}, OffsetRotation:{1}", part2.OffsetPosition, part2.RotationOffset);
+                
+                System.Console.WriteLine("Group3: parts: {0}", grp3.Children.Count);
+                System.Console.WriteLine("Group3: Pos:{0}, Rot:{1}", grp3.AbsolutePosition, grp3.Rotation);
+                System.Console.WriteLine("Group3: Prim1: OffsetPosition:{0}, OffsetRotation:{1}", part3.OffsetPosition, part3.RotationOffset);
+                System.Console.WriteLine("Group3: Prim2: OffsetPosition:{0}, OffsetRotation:{1}", part4.OffsetPosition, part4.RotationOffset);
+            }
+
+            // root part should have no offset position or rotation
+            Assert.That(part1.OffsetPosition == Vector3.Zero && part1.RotationOffset == Quaternion.Identity);
+
+            // offset position should be root part position - part2.absolute position.
+            Assert.That(part2.OffsetPosition == new Vector3(-10, -10, -10));
+
+            float roll = 0;
+            float pitch = 0;
+            float yaw = 0;
+
+            // There's a euler anomoly at 180, 0, 0 so expect 180 to turn into -180.
+            part1.RotationOffset.GetEulerAngles(out roll, out pitch, out yaw);
+            Vector3 rotEuler1 = new Vector3(roll * Utils.RAD_TO_DEG, pitch * Utils.RAD_TO_DEG, yaw * Utils.RAD_TO_DEG);
+
+            if (debugtest)
+                System.Console.WriteLine(rotEuler1);
+
+            part2.RotationOffset.GetEulerAngles(out roll, out pitch, out yaw);
+            Vector3 rotEuler2 = new Vector3(roll * Utils.RAD_TO_DEG, pitch * Utils.RAD_TO_DEG, yaw * Utils.RAD_TO_DEG);
+
+            if (debugtest)
+                System.Console.WriteLine(rotEuler2);
+
+            Assert.That(rotEuler2.ApproxEquals(new Vector3(-180, 0, 0), 0.001f) || rotEuler2.ApproxEquals(new Vector3(180, 0, 0), 0.001f));
+
+            // Now we're linking the first group to the second group.  This will make the second group child parts of the first one.
+            grp3.LinkToGroup(grp1);
+
+            // Delink part 2
+            grp1.DelinkFromGroup(part2.LocalId);
+
+            grp1.DelinkFromGroup(part3.LocalId);
+
+            if (debugtest)
+            {
+                System.Console.WriteLine("--------After De-Link-------");
+                System.Console.WriteLine("Group1: parts: {0}", grp1.Children.Count);
+                System.Console.WriteLine("Group1: Pos:{0}, Rot:{1}", grp1.AbsolutePosition, grp1.Rotation);
+                System.Console.WriteLine("Group1: Prim1: OffsetPosition:{0}, OffsetRotation:{1}", part1.OffsetPosition, part1.RotationOffset);
+                System.Console.WriteLine("NoGroup: Prim2: AbsolutePosition:{0}, OffsetRotation:{1}", part2.AbsolutePosition, part2.RotationOffset);
+
+                System.Console.WriteLine("Group3: parts: {0}", grp3.Children.Count);
+                System.Console.WriteLine("Group3: Pos:{0}, Rot:{1}", grp3.AbsolutePosition, grp3.Rotation);
+                System.Console.WriteLine("Group3: Prim1: OffsetPosition:{0}, OffsetRotation:{1}", part3.OffsetPosition, part3.RotationOffset);
+                System.Console.WriteLine("Group3: Prim2: OffsetPosition:{0}, OffsetRotation:{1}", part4.OffsetPosition, part4.RotationOffset);
+            }
+
+            Assert.That(part2.AbsolutePosition == Vector3.Zero);
+            Assert.That(part4.OffsetPosition == new Vector3(20, 20, 20));
+            Quaternion compareQuaternion = new Quaternion(0, 0.7071068f, 0, 0.7071068f);
+            Assert.That((part4.RotationOffset.X - compareQuaternion.X < 0.00003) 
+                && (part4.RotationOffset.Y - compareQuaternion.Y < 0.00003) 
+                && (part4.RotationOffset.Z - compareQuaternion.Z < 0.00003) 
+                && (part4.RotationOffset.W - compareQuaternion.W < 0.00003));
+
+        }
  
         /// <summary>
         /// Test deleting an object asynchronously to user inventory.