/// <summary>
        /// Construct TrapezoidalMap
        /// </summary>
        public TrapezoidalMap(List<Common.Segment> segments)
        {
            int n = segments.Count();
            IEnumerable<int> RandomPermutation = new RandomPermutation(n);

            Trapezoid RecBoundary = RectangleBoundary(segments);
            Root = new TrapezoidalNode(RecBoundary);
            RecBoundary.Node = Root;

            foreach (int i in RandomPermutation)
            {
                Vertex leftVertex;
                Vertex rightVertex;
                if (segments[i].Vertex1.X < segments[i].Vertex2.X)
                {
                    leftVertex = new Vertex(segments[i].Vertex1.X, segments[i].Vertex1.Y);
                    rightVertex = new Vertex(segments[i].Vertex2.X, segments[i].Vertex2.Y);
                }
                else
                {
                    leftVertex = new Vertex(segments[i].Vertex2.X, segments[i].Vertex2.Y);
                    rightVertex = new Vertex(segments[i].Vertex1.X, segments[i].Vertex1.Y);
                }

                Segment newsegment = new Segment(leftVertex, rightVertex);
                var ListInterTraps = FindIntersectedTraps(newsegment);                               // List of trapezoids that intersect segment

                // Update search structure
                // SECTION 1: a trapezoid contain segment
                //

                if (ListInterTraps.Count == 1)
                {
                    Trapezoid interTrap = ListInterTraps.Last();                                    // Intersected trapezoid

                    // Case1: Top contains left of segment, bottom contains right of segment
                    if (leftVertex.Equals(interTrap.Top.LeftVertex) && rightVertex.Equals(interTrap.Bottom.RightVertex))
                    {
                        Node Children = ((TrapezoidalNode)interTrap.Node).To2TrapsTopLeft_BottomRight(newsegment);
                        foreach (Node parent in interTrap.Node.Parent)
                        {
                            if (parent.LeftChildren.IsTrapezoid && ((TrapezoidalNode)parent.LeftChildren).Trapezoid.Equals(interTrap))
                                parent.SetLeftChildren(ref Children);
                            else
                                parent.SetRightChildren(ref Children);
                        }
                    }

                    // Case2: Top contains left of segment and right vertical edge contains right of segment
                    else if (leftVertex.Equals(interTrap.Top.LeftVertex) && interTrap.Rightp.X == rightVertex.X)
                    {
                        Node Children = ((TrapezoidalNode)interTrap.Node).To2TrapsTopLeft_CenterRight(newsegment);
                        foreach (Node parent in interTrap.Node.Parent)
                        {
                            if (parent.LeftChildren.IsTrapezoid && ((TrapezoidalNode)parent.LeftChildren).Trapezoid.Equals(interTrap))
                                parent.SetLeftChildren(ref Children);
                            else
                                parent.SetRightChildren(ref Children);
                        }
                    }

                    // Case3: Bottom contains left of segment, top contains right of segment
                    else if (leftVertex.Equals(interTrap.Bottom.LeftVertex) && rightVertex.Equals(interTrap.Top.RightVertex))
                    {
                        Node Children = ((TrapezoidalNode)interTrap.Node).To2TrapsTopRight_BottomLeft(newsegment);
                        foreach (Node parent in interTrap.Node.Parent)
                        {
                            if (parent.LeftChildren.IsTrapezoid && ((TrapezoidalNode)parent.LeftChildren).Trapezoid.Equals(interTrap))
                                parent.SetLeftChildren(ref Children);
                            else
                                parent.SetRightChildren(ref Children);
                        }
                    }

                    // Case4: Bottom contains left of segment and right vertical edge contains right of segment
                    else if (leftVertex.Equals(interTrap.Bottom.LeftVertex) && interTrap.Rightp.X == rightVertex.X)
                    {
                        Node Children = ((TrapezoidalNode)interTrap.Node).To2TrapsBottomLeft_CenterRight(newsegment);
                        foreach (Node parent in interTrap.Node.Parent)
                        {
                            if (parent.LeftChildren.IsTrapezoid && ((TrapezoidalNode)parent.LeftChildren).Trapezoid.Equals(interTrap))
                                parent.SetLeftChildren(ref Children);
                            else
                                parent.SetRightChildren(ref Children);
                        }
                    }

                    // Case5: Left vertical edge contains left of segment and top contains right of segment
                    else if (leftVertex.X == interTrap.Leftp.X && rightVertex.Equals(interTrap.Top.RightVertex))
                    {
                        Node Children = ((TrapezoidalNode)interTrap.Node).To2TrapsTopRight_CenterLeft(newsegment);
                        foreach (Node parent in interTrap.Node.Parent)
                        {
                            if (parent.LeftChildren.IsTrapezoid && ((TrapezoidalNode)parent.LeftChildren).Trapezoid.Equals(interTrap))
                                parent.SetLeftChildren(ref Children);
                            else
                                parent.SetRightChildren(ref Children);
                        }
                    }

                    // Case6: Left vertical edge contains left of segment and bottom contains right of segment
                    else if (leftVertex.X == interTrap.Leftp.X && rightVertex.Equals(interTrap.Bottom.RightVertex))
                    {
                        Node Children = ((TrapezoidalNode)interTrap.Node).To2TrapsBottomRight_CenterLeft(newsegment);
                        foreach (Node parent in interTrap.Node.Parent)
                        {
                            if (parent.LeftChildren.IsTrapezoid && ((TrapezoidalNode)parent.LeftChildren).Trapezoid.Equals(interTrap))
                                parent.SetLeftChildren(ref Children);
                            else
                                parent.SetRightChildren(ref Children);
                        }
                    }

                    // Case7: Left vertical edge contains left of segment and right vertical edge contains right of segment
                    else if (leftVertex.X == interTrap.Leftp.X && rightVertex.X == interTrap.Rightp.X)
                    {
                        Node Children = ((TrapezoidalNode)interTrap.Node).To2TrapsCenterRight_CenterLeft(newsegment);
                        foreach (Node parent in interTrap.Node.Parent)
                        {
                            if (parent.LeftChildren.IsTrapezoid && ((TrapezoidalNode)parent.LeftChildren).Trapezoid.Equals(interTrap))
                                parent.SetLeftChildren(ref Children);
                            else
                                parent.SetRightChildren(ref Children);
                        }
                    }

                    // Case8: Top contains left of segment and right vertical edge doesn't contain right of segment
                    else if (leftVertex.Equals(interTrap.Top.LeftVertex))
                    {
                        Node Children = ((TrapezoidalNode)interTrap.Node).To3TrapsTopLeft(newsegment);
                        foreach (Node parent in interTrap.Node.Parent)
                        {
                            if (parent.LeftChildren.IsTrapezoid && ((TrapezoidalNode)parent.LeftChildren).Trapezoid.Equals(interTrap))
                                parent.SetLeftChildren(ref Children);
                            else
                                parent.SetRightChildren(ref Children);
                        }
                    }

                    // Case9: Bottom contains left of segment and right vertical edge doesn't contain right of segment
                    else if (leftVertex.Equals(interTrap.Bottom.LeftVertex))
                    {
                        Node Children = ((TrapezoidalNode)interTrap.Node).To3TrapsBottomLeft(newsegment);
                        foreach (Node parent in interTrap.Node.Parent)
                        {
                            if (parent.LeftChildren.IsTrapezoid && ((TrapezoidalNode)parent.LeftChildren).Trapezoid.Equals(interTrap))
                                parent.SetLeftChildren(ref Children);
                            else
                                parent.SetRightChildren(ref Children);
                        }
                    }

                    // Case10: Left vertical edge contains left of segment and right vertical edge doesn't contain right of segment
                    else if (leftVertex.X == interTrap.Leftp.X)
                    {
                        Node Children = ((TrapezoidalNode)interTrap.Node).To3TrapsCenterLeft(newsegment);
                        foreach (Node parent in interTrap.Node.Parent)
                        {
                            if (parent.LeftChildren.IsTrapezoid && ((TrapezoidalNode)parent.LeftChildren).Trapezoid.Equals(interTrap))
                                parent.SetLeftChildren(ref Children);
                            else
                                parent.SetRightChildren(ref Children);
                        }
                    }

                    // Case11: Left vertical edge doesn't contains left of segment and top contain right of segment
                    else if (rightVertex.Equals(interTrap.Top.RightVertex))
                    {
                        Node Children = ((TrapezoidalNode)interTrap.Node).To3TrapsTopRight(newsegment);
                        foreach (Node parent in interTrap.Node.Parent)
                        {
                            if (parent.LeftChildren.IsTrapezoid && ((TrapezoidalNode)parent.LeftChildren).Trapezoid.Equals(interTrap))
                                parent.SetLeftChildren(ref Children);
                            else
                                parent.SetRightChildren(ref Children);
                        }
                    }

                    // Case12: Left vertical edge doesn't contains left of segment and bottom contain right of segment
                    else if (rightVertex.Equals(interTrap.Bottom.RightVertex))
                    {
                        Node Children = ((TrapezoidalNode)interTrap.Node).To3TrapsBottomRight(newsegment);
                        foreach (Node parent in interTrap.Node.Parent)
                        {
                            if (parent.LeftChildren.IsTrapezoid && ((TrapezoidalNode)parent.LeftChildren).Trapezoid.Equals(interTrap))
                                parent.SetLeftChildren(ref Children);
                            else
                                parent.SetRightChildren(ref Children);
                        }
                    }

                    // Case13: Left vertical edge doesn't contains left of segment and right vertical edge contain right of segment
                    else if (rightVertex.X == interTrap.Rightp.X)
                    {
                        Node Children = ((TrapezoidalNode)interTrap.Node).To3TrapsCenterRight(newsegment);
                        foreach (Node parent in interTrap.Node.Parent)
                        {
                            if (parent.LeftChildren.IsTrapezoid && ((TrapezoidalNode)parent.LeftChildren).Trapezoid.Equals(interTrap))
                                parent.SetLeftChildren(ref Children);
                            else
                                parent.SetRightChildren(ref Children);
                        }
                    }

                    // Case14: Left vertical edge doesn't contains left of segment and right vertical edge doesn't contain right of segment
                    else
                    {
                        Node Children = ((TrapezoidalNode)interTrap.Node).To4Traps(newsegment);
                        if (interTrap.Node.Parent.Count != 0)
                            foreach (Node parent in interTrap.Node.Parent)
                            {
                                if (parent.LeftChildren.IsTrapezoid && ((TrapezoidalNode)parent.LeftChildren).Trapezoid.Equals(interTrap))
                                    parent.SetLeftChildren(ref Children);
                                else
                                    parent.SetRightChildren(ref Children);
                            }
                        else
                            Root = Children;
                    }
                }

                //
                // SECTION 2: many trapezoids intersect segment
                //

                else
                {
                    List<int> WaitTraps = new List<int>();
                    bool HigherTrapsWait = false;
                    bool LowerTrapsWait = false;
                    List<Node> ListChildrens = new List<Node>();
                    bool FirstExcess = false;
                    bool LastExcess = false;

                    // First trapezoid

                    Trapezoid FirstTrap = ListInterTraps[0];
                    Node FirstChildren = new Node();
                    // Case 1: Top contains left of segment
                    if (FirstTrap.Top.LeftVertex.Equals(newsegment.LeftVertex))
                    {
                        FirstChildren = ((TrapezoidalNode)FirstTrap.Node).To2TrapsTopLeft(newsegment);
                        if (FirstTrap.Top.RightVertex.Equals(FirstTrap.Rightp))
                        {
                            ((TrapezoidalNode)FirstChildren.LeftChildren).Trapezoid.SetVertex(newsegment.LeftVertex, FirstTrap.Rightp);
                            ((TrapezoidalNode)FirstChildren.RightChildren).Trapezoid.SetVertex(newsegment.LeftVertex, null);
                        }
                        else
                        {
                            ((TrapezoidalNode)FirstChildren.RightChildren).Trapezoid.SetVertex(newsegment.LeftVertex, FirstTrap.Rightp);
                            ((TrapezoidalNode)FirstChildren.LeftChildren).Trapezoid.SetVertex(newsegment.LeftVertex, null);
                        }
                        ListChildrens.Add(FirstChildren);
                    }
                    // Case 2: Bottom contains left of segment
                    else if (FirstTrap.Bottom.LeftVertex.Equals(newsegment.LeftVertex))
                    {
                        FirstChildren = ((TrapezoidalNode)FirstTrap.Node).To2TrapsBottomLeft(newsegment);
                        if (FirstTrap.Top.RightVertex.Equals(FirstTrap.Rightp))
                        {
                            ((TrapezoidalNode)FirstChildren.LeftChildren).Trapezoid.SetVertex(newsegment.LeftVertex, FirstTrap.Rightp);
                            ((TrapezoidalNode)FirstChildren.RightChildren).Trapezoid.SetVertex(newsegment.LeftVertex, null);
                        }
                        else
                        {
                            ((TrapezoidalNode)FirstChildren.RightChildren).Trapezoid.SetVertex(newsegment.LeftVertex, FirstTrap.Rightp);
                            ((TrapezoidalNode)FirstChildren.LeftChildren).Trapezoid.SetVertex(newsegment.LeftVertex, null);
                        }
                        ListChildrens.Add(FirstChildren);
                    }
                    // Case 3:  Left vertical edge contains left of segment
                    else if (FirstTrap.Leftp.X == newsegment.LeftVertex.X)
                    {
                        FirstChildren = ((TrapezoidalNode)FirstTrap.Node).To2TrapsCenterLeft(newsegment);
                        if (FirstTrap.Top.RightVertex.Equals(FirstTrap.Rightp))
                        {
                            ((TrapezoidalNode)FirstChildren.LeftChildren).Trapezoid.SetVertex(newsegment.LeftVertex, FirstTrap.Rightp);
                            ((TrapezoidalNode)FirstChildren.RightChildren).Trapezoid.SetVertex(newsegment.LeftVertex, null);
                        }
                        else
                        {
                            ((TrapezoidalNode)FirstChildren.RightChildren).Trapezoid.SetVertex(newsegment.LeftVertex, FirstTrap.Rightp);
                            ((TrapezoidalNode)FirstChildren.LeftChildren).Trapezoid.SetVertex(newsegment.LeftVertex, null);
                        }
                        ListChildrens.Add(FirstChildren);
                    }
                    // Case 4:  Left vertical edge doesn't contain left of segment
                    else
                    {
                        FirstChildren = ((TrapezoidalNode)FirstTrap.Node).To3TrapsLeft_2Right(newsegment);
                        FirstExcess = true;
                        if (FirstTrap.Top.RightVertex.Equals(FirstTrap.Rightp))
                        {
                            ((TrapezoidalNode)FirstChildren.RightChildren.LeftChildren).Trapezoid.SetVertex(newsegment.LeftVertex, FirstTrap.Rightp);
                            ((TrapezoidalNode)FirstChildren.RightChildren.RightChildren).Trapezoid.SetVertex(newsegment.LeftVertex, null);
                        }
                        else
                        {
                            ((TrapezoidalNode)FirstChildren.RightChildren.RightChildren).Trapezoid.SetVertex(newsegment.LeftVertex, FirstTrap.Rightp);
                            ((TrapezoidalNode)FirstChildren.RightChildren.LeftChildren).Trapezoid.SetVertex(newsegment.LeftVertex, null);
                        }
                        ListChildrens.Add(FirstChildren.RightChildren);
                    }

                    // Middle trapezoids

                    for (int j = 1; j < ListInterTraps.Count - 1; j++)
                    {
                        Trapezoid MidTrap = ListInterTraps[j];
                        Node MidChildren = ((TrapezoidalNode)MidTrap.Node).To2Traps(newsegment);

                        if (MidTrap.Top.LeftVertex.Equals(MidTrap.Leftp))
                        {
                            ((TrapezoidalNode)MidChildren.LeftChildren).Trapezoid.SetLeftVertex(MidTrap.Leftp);
                            ((TrapezoidalNode)MidChildren.RightChildren).Trapezoid.SetLeftVertex(null);
                        }
                        else
                        {
                            ((TrapezoidalNode)MidChildren.RightChildren).Trapezoid.SetLeftVertex(MidTrap.Leftp);
                            ((TrapezoidalNode)MidChildren.LeftChildren).Trapezoid.SetLeftVertex(null);
                        }

                        if (MidTrap.Top.RightVertex.Equals(MidTrap.Rightp))
                        {
                            ((TrapezoidalNode)MidChildren.LeftChildren).Trapezoid.SetRightVertex(MidTrap.Rightp);
                            ((TrapezoidalNode)MidChildren.RightChildren).Trapezoid.SetRightVertex(null);
                        }
                        else
                        {
                            ((TrapezoidalNode)MidChildren.RightChildren).Trapezoid.SetRightVertex(MidTrap.Rightp);
                            ((TrapezoidalNode)MidChildren.LeftChildren).Trapezoid.SetRightVertex(null);
                        }
                        ListChildrens.Add(MidChildren);
                    }

                    // Last trapezoid

                    Trapezoid LastTrap = ListInterTraps.Last();
                    Node LastChildren = new Node();
                    // Case 1: Top contains right of segment
                    if (LastTrap.Top.RightVertex.Equals(newsegment.RightVertex))
                    {
                        LastChildren = ((TrapezoidalNode)LastTrap.Node).To2TrapsTopRight(newsegment);
                        if (LastTrap.Top.LeftVertex.Equals(LastTrap.Leftp))
                        {
                            ((TrapezoidalNode)LastChildren.LeftChildren).Trapezoid.SetVertex(LastTrap.Leftp, newsegment.RightVertex);
                            ((TrapezoidalNode)LastChildren.RightChildren).Trapezoid.SetVertex(null, newsegment.RightVertex);
                        }
                        else
                        {
                            ((TrapezoidalNode)LastChildren.RightChildren).Trapezoid.SetVertex(LastTrap.Leftp, newsegment.RightVertex);
                            ((TrapezoidalNode)LastChildren.LeftChildren).Trapezoid.SetVertex(null, newsegment.RightVertex);
                        }
                        ListChildrens.Add(LastChildren);
                    }
                    // Case 2: Bottom contains right of segment
                    else if (LastTrap.Bottom.RightVertex.Equals(newsegment.RightVertex))
                    {
                        LastChildren = ((TrapezoidalNode)LastTrap.Node).To2TrapsBottomRight(newsegment);
                        if (LastTrap.Top.LeftVertex.Equals(LastTrap.Leftp))
                        {
                            ((TrapezoidalNode)LastChildren.LeftChildren).Trapezoid.SetVertex(LastTrap.Leftp, newsegment.RightVertex);
                            ((TrapezoidalNode)LastChildren.RightChildren).Trapezoid.SetVertex(null, newsegment.RightVertex);
                        }
                        else
                        {
                            ((TrapezoidalNode)LastChildren.RightChildren).Trapezoid.SetVertex(LastTrap.Leftp, newsegment.RightVertex);
                            ((TrapezoidalNode)LastChildren.LeftChildren).Trapezoid.SetVertex(null, newsegment.RightVertex);
                        }
                        ListChildrens.Add(LastChildren);
                    }
                    // Case 3:  Left vertical edge contains right of segment
                    else if (LastTrap.Rightp.X == newsegment.RightVertex.X)
                    {
                        LastChildren = ((TrapezoidalNode)LastTrap.Node).To2TrapsCenterRight(newsegment);
                        if (LastTrap.Top.LeftVertex.Equals(LastTrap.Leftp))
                        {
                            ((TrapezoidalNode)LastChildren.LeftChildren).Trapezoid.SetVertex(LastTrap.Leftp, newsegment.RightVertex);
                            ((TrapezoidalNode)LastChildren.RightChildren).Trapezoid.SetVertex(null, newsegment.RightVertex);
                        }
                        else
                        {
                            ((TrapezoidalNode)LastChildren.RightChildren).Trapezoid.SetVertex(LastTrap.Leftp, newsegment.RightVertex);
                            ((TrapezoidalNode)LastChildren.LeftChildren).Trapezoid.SetVertex(null, newsegment.RightVertex);
                        }
                        ListChildrens.Add(LastChildren);
                    }
                    // Case 4:  Left vertical edge doesn't contain left of segment
                    else
                    {
                        LastChildren = ((TrapezoidalNode)LastTrap.Node).To3TrapsRight_2Left(newsegment);
                        LastExcess = true;
                        if (LastTrap.Top.LeftVertex.Equals(LastTrap.Leftp))
                        {
                            ((TrapezoidalNode)LastChildren.LeftChildren.LeftChildren).Trapezoid.SetVertex(LastTrap.Leftp, newsegment.RightVertex);
                            ((TrapezoidalNode)LastChildren.LeftChildren.RightChildren).Trapezoid.SetVertex(null, newsegment.RightVertex);
                        }
                        else
                        {
                            ((TrapezoidalNode)LastChildren.LeftChildren.RightChildren).Trapezoid.SetVertex(LastTrap.Leftp, newsegment.RightVertex);
                            ((TrapezoidalNode)LastChildren.LeftChildren.LeftChildren).Trapezoid.SetVertex(null, newsegment.RightVertex);
                        }
                        ListChildrens.Add(LastChildren.LeftChildren);
                    }

                    ((TrapezoidalNode)ListChildrens[0].LeftChildren).Trapezoid.SetRightNeighbor(((TrapezoidalNode)ListChildrens[1].LeftChildren).Trapezoid, ((TrapezoidalNode)ListChildrens[1].LeftChildren).Trapezoid);
                    ((TrapezoidalNode)ListChildrens[0].RightChildren).Trapezoid.SetRightNeighbor(((TrapezoidalNode)ListChildrens[1].RightChildren).Trapezoid, ((TrapezoidalNode)ListChildrens[1].RightChildren).Trapezoid);

                    ((TrapezoidalNode)ListChildrens.Last().LeftChildren).Trapezoid.SetLeftNeighbor(((TrapezoidalNode)ListChildrens[ListChildrens.Count - 2].LeftChildren).Trapezoid, ((TrapezoidalNode)ListChildrens[ListChildrens.Count - 2].LeftChildren).Trapezoid);
                    ((TrapezoidalNode)ListChildrens.Last().RightChildren).Trapezoid.SetLeftNeighbor(((TrapezoidalNode)ListChildrens[ListChildrens.Count - 2].RightChildren).Trapezoid, ((TrapezoidalNode)ListChildrens[ListChildrens.Count - 2].RightChildren).Trapezoid);

                    for (int j = 1; j < ListChildrens.Count - 1; j++)
                    {
                        ((TrapezoidalNode)ListChildrens[j].LeftChildren).Trapezoid.SetRightNeighbor(((TrapezoidalNode)ListChildrens[j + 1].LeftChildren).Trapezoid, ((TrapezoidalNode)ListChildrens[j + 1].LeftChildren).Trapezoid);
                        ((TrapezoidalNode)ListChildrens[j].RightChildren).Trapezoid.SetRightNeighbor(((TrapezoidalNode)ListChildrens[j + 1].RightChildren).Trapezoid, ((TrapezoidalNode)ListChildrens[j + 1].RightChildren).Trapezoid);
                        ((TrapezoidalNode)ListChildrens[j].LeftChildren).Trapezoid.SetLeftNeighbor(((TrapezoidalNode)ListChildrens[j - 1].LeftChildren).Trapezoid, ((TrapezoidalNode)ListChildrens[j + 1].LeftChildren).Trapezoid);
                        ((TrapezoidalNode)ListChildrens[j].RightChildren).Trapezoid.SetLeftNeighbor(((TrapezoidalNode)ListChildrens[j - 1].RightChildren).Trapezoid, ((TrapezoidalNode)ListChildrens[j + 1].RightChildren).Trapezoid);
                    }

                    bool continueCheck = true;
                    while (continueCheck)
                    {
                        continueCheck = false;
                        for (int j = 0; j < ListChildrens.Count - 1; j++)
                        {
                            if (((TrapezoidalNode)ListChildrens[j].LeftChildren).Trapezoid.Rightp == null)
                            {
                                continueCheck = true;
                                Trapezoid oldLeftTrap = ((TrapezoidalNode)ListChildrens[j].LeftChildren).Trapezoid;
                                Trapezoid oldRightTrap = ((TrapezoidalNode)ListChildrens[j + 1].LeftChildren).Trapezoid;
                                Trapezoid newTrap = new Trapezoid(oldLeftTrap.Leftp, oldRightTrap.Rightp, oldLeftTrap.Top, oldLeftTrap.Bottom);
                                newTrap.SetNeighbor(oldLeftTrap.HigherLeftNeighbor, oldLeftTrap.LowerLeftNeighbor, oldRightTrap.HigherRightNeighbor, oldRightTrap.LowerRightNeighbor);
                                TrapezoidalNode newNode = new TrapezoidalNode(newTrap);
                                ListChildrens[j].LeftChildren = newNode;
                                ListChildrens[j + 1].LeftChildren = newNode;
                            }

                            if (((TrapezoidalNode)ListChildrens[j].RightChildren).Trapezoid.Rightp == null)
                            {
                                continueCheck = true;
                                Trapezoid oldLeftTrap = ((TrapezoidalNode)ListChildrens[j].RightChildren).Trapezoid;
                                Trapezoid oldRightTrap = ((TrapezoidalNode)ListChildrens[j + 1].RightChildren).Trapezoid;
                                Trapezoid newTrap = new Trapezoid(oldLeftTrap.Leftp, oldRightTrap.Rightp, oldLeftTrap.Top, oldLeftTrap.Bottom);
                                newTrap.SetNeighbor(oldLeftTrap.HigherLeftNeighbor, oldLeftTrap.LowerLeftNeighbor, oldRightTrap.HigherRightNeighbor, oldRightTrap.LowerRightNeighbor);
                                TrapezoidalNode newNode = new TrapezoidalNode(newTrap);
                                ListChildrens[j].RightChildren = newNode;
                                ListChildrens[j + 1].RightChildren = newNode;
                            }

                        }
                    }
                }
            }
        }
Ejemplo n.º 2
0
        /// <summary>
        /// Construct TrapezoidalMap
        /// </summary>

        public TrapezoidalMap(List <Common.Segment> segments)
        {
            int n = segments.Count();
            IEnumerable <int> RandomPermutation = new RandomPermutation(n);

            Trapezoid RecBoundary = RectangleBoundary(segments);

            Root             = new TrapezoidalNode(RecBoundary);
            RecBoundary.Node = Root;

            foreach (int i in RandomPermutation)
            {
                Vertex leftVertex;
                Vertex rightVertex;
                if (segments[i].Vertex1.X < segments[i].Vertex2.X)
                {
                    leftVertex  = new Vertex(segments[i].Vertex1.X, segments[i].Vertex1.Y);
                    rightVertex = new Vertex(segments[i].Vertex2.X, segments[i].Vertex2.Y);
                }
                else
                {
                    leftVertex  = new Vertex(segments[i].Vertex2.X, segments[i].Vertex2.Y);
                    rightVertex = new Vertex(segments[i].Vertex1.X, segments[i].Vertex1.Y);
                }

                Segment newsegment     = new Segment(leftVertex, rightVertex);
                var     ListInterTraps = FindIntersectedTraps(newsegment);                           // List of trapezoids that intersect segment


                // Update search structure
                // SECTION 1: a trapezoid contain segment
                //

                if (ListInterTraps.Count == 1)
                {
                    Trapezoid interTrap = ListInterTraps.Last();                                    // Intersected trapezoid

                    // Case1: Top contains left of segment, bottom contains right of segment
                    if (leftVertex.Equals(interTrap.Top.LeftVertex) && rightVertex.Equals(interTrap.Bottom.RightVertex))
                    {
                        Node Children = ((TrapezoidalNode)interTrap.Node).To2TrapsTopLeft_BottomRight(newsegment);
                        foreach (Node parent in interTrap.Node.Parent)
                        {
                            if (parent.LeftChildren.IsTrapezoid && ((TrapezoidalNode)parent.LeftChildren).Trapezoid.Equals(interTrap))
                            {
                                parent.SetLeftChildren(ref Children);
                            }
                            else
                            {
                                parent.SetRightChildren(ref Children);
                            }
                        }
                    }

                    // Case2: Top contains left of segment and right vertical edge contains right of segment
                    else if (leftVertex.Equals(interTrap.Top.LeftVertex) && interTrap.Rightp.X == rightVertex.X)
                    {
                        Node Children = ((TrapezoidalNode)interTrap.Node).To2TrapsTopLeft_CenterRight(newsegment);
                        foreach (Node parent in interTrap.Node.Parent)
                        {
                            if (parent.LeftChildren.IsTrapezoid && ((TrapezoidalNode)parent.LeftChildren).Trapezoid.Equals(interTrap))
                            {
                                parent.SetLeftChildren(ref Children);
                            }
                            else
                            {
                                parent.SetRightChildren(ref Children);
                            }
                        }
                    }

                    // Case3: Bottom contains left of segment, top contains right of segment
                    else if (leftVertex.Equals(interTrap.Bottom.LeftVertex) && rightVertex.Equals(interTrap.Top.RightVertex))
                    {
                        Node Children = ((TrapezoidalNode)interTrap.Node).To2TrapsTopRight_BottomLeft(newsegment);
                        foreach (Node parent in interTrap.Node.Parent)
                        {
                            if (parent.LeftChildren.IsTrapezoid && ((TrapezoidalNode)parent.LeftChildren).Trapezoid.Equals(interTrap))
                            {
                                parent.SetLeftChildren(ref Children);
                            }
                            else
                            {
                                parent.SetRightChildren(ref Children);
                            }
                        }
                    }

                    // Case4: Bottom contains left of segment and right vertical edge contains right of segment
                    else if (leftVertex.Equals(interTrap.Bottom.LeftVertex) && interTrap.Rightp.X == rightVertex.X)
                    {
                        Node Children = ((TrapezoidalNode)interTrap.Node).To2TrapsBottomLeft_CenterRight(newsegment);
                        foreach (Node parent in interTrap.Node.Parent)
                        {
                            if (parent.LeftChildren.IsTrapezoid && ((TrapezoidalNode)parent.LeftChildren).Trapezoid.Equals(interTrap))
                            {
                                parent.SetLeftChildren(ref Children);
                            }
                            else
                            {
                                parent.SetRightChildren(ref Children);
                            }
                        }
                    }

                    // Case5: Left vertical edge contains left of segment and top contains right of segment
                    else if (leftVertex.X == interTrap.Leftp.X && rightVertex.Equals(interTrap.Top.RightVertex))
                    {
                        Node Children = ((TrapezoidalNode)interTrap.Node).To2TrapsTopRight_CenterLeft(newsegment);
                        foreach (Node parent in interTrap.Node.Parent)
                        {
                            if (parent.LeftChildren.IsTrapezoid && ((TrapezoidalNode)parent.LeftChildren).Trapezoid.Equals(interTrap))
                            {
                                parent.SetLeftChildren(ref Children);
                            }
                            else
                            {
                                parent.SetRightChildren(ref Children);
                            }
                        }
                    }

                    // Case6: Left vertical edge contains left of segment and bottom contains right of segment
                    else if (leftVertex.X == interTrap.Leftp.X && rightVertex.Equals(interTrap.Bottom.RightVertex))
                    {
                        Node Children = ((TrapezoidalNode)interTrap.Node).To2TrapsBottomRight_CenterLeft(newsegment);
                        foreach (Node parent in interTrap.Node.Parent)
                        {
                            if (parent.LeftChildren.IsTrapezoid && ((TrapezoidalNode)parent.LeftChildren).Trapezoid.Equals(interTrap))
                            {
                                parent.SetLeftChildren(ref Children);
                            }
                            else
                            {
                                parent.SetRightChildren(ref Children);
                            }
                        }
                    }

                    // Case7: Left vertical edge contains left of segment and right vertical edge contains right of segment
                    else if (leftVertex.X == interTrap.Leftp.X && rightVertex.X == interTrap.Rightp.X)
                    {
                        Node Children = ((TrapezoidalNode)interTrap.Node).To2TrapsCenterRight_CenterLeft(newsegment);
                        foreach (Node parent in interTrap.Node.Parent)
                        {
                            if (parent.LeftChildren.IsTrapezoid && ((TrapezoidalNode)parent.LeftChildren).Trapezoid.Equals(interTrap))
                            {
                                parent.SetLeftChildren(ref Children);
                            }
                            else
                            {
                                parent.SetRightChildren(ref Children);
                            }
                        }
                    }

                    // Case8: Top contains left of segment and right vertical edge doesn't contain right of segment
                    else if (leftVertex.Equals(interTrap.Top.LeftVertex))
                    {
                        Node Children = ((TrapezoidalNode)interTrap.Node).To3TrapsTopLeft(newsegment);
                        foreach (Node parent in interTrap.Node.Parent)
                        {
                            if (parent.LeftChildren.IsTrapezoid && ((TrapezoidalNode)parent.LeftChildren).Trapezoid.Equals(interTrap))
                            {
                                parent.SetLeftChildren(ref Children);
                            }
                            else
                            {
                                parent.SetRightChildren(ref Children);
                            }
                        }
                    }

                    // Case9: Bottom contains left of segment and right vertical edge doesn't contain right of segment
                    else if (leftVertex.Equals(interTrap.Bottom.LeftVertex))
                    {
                        Node Children = ((TrapezoidalNode)interTrap.Node).To3TrapsBottomLeft(newsegment);
                        foreach (Node parent in interTrap.Node.Parent)
                        {
                            if (parent.LeftChildren.IsTrapezoid && ((TrapezoidalNode)parent.LeftChildren).Trapezoid.Equals(interTrap))
                            {
                                parent.SetLeftChildren(ref Children);
                            }
                            else
                            {
                                parent.SetRightChildren(ref Children);
                            }
                        }
                    }

                    // Case10: Left vertical edge contains left of segment and right vertical edge doesn't contain right of segment
                    else if (leftVertex.X == interTrap.Leftp.X)
                    {
                        Node Children = ((TrapezoidalNode)interTrap.Node).To3TrapsCenterLeft(newsegment);
                        foreach (Node parent in interTrap.Node.Parent)
                        {
                            if (parent.LeftChildren.IsTrapezoid && ((TrapezoidalNode)parent.LeftChildren).Trapezoid.Equals(interTrap))
                            {
                                parent.SetLeftChildren(ref Children);
                            }
                            else
                            {
                                parent.SetRightChildren(ref Children);
                            }
                        }
                    }

                    // Case11: Left vertical edge doesn't contains left of segment and top contain right of segment
                    else if (rightVertex.Equals(interTrap.Top.RightVertex))
                    {
                        Node Children = ((TrapezoidalNode)interTrap.Node).To3TrapsTopRight(newsegment);
                        foreach (Node parent in interTrap.Node.Parent)
                        {
                            if (parent.LeftChildren.IsTrapezoid && ((TrapezoidalNode)parent.LeftChildren).Trapezoid.Equals(interTrap))
                            {
                                parent.SetLeftChildren(ref Children);
                            }
                            else
                            {
                                parent.SetRightChildren(ref Children);
                            }
                        }
                    }

                    // Case12: Left vertical edge doesn't contains left of segment and bottom contain right of segment
                    else if (rightVertex.Equals(interTrap.Bottom.RightVertex))
                    {
                        Node Children = ((TrapezoidalNode)interTrap.Node).To3TrapsBottomRight(newsegment);
                        foreach (Node parent in interTrap.Node.Parent)
                        {
                            if (parent.LeftChildren.IsTrapezoid && ((TrapezoidalNode)parent.LeftChildren).Trapezoid.Equals(interTrap))
                            {
                                parent.SetLeftChildren(ref Children);
                            }
                            else
                            {
                                parent.SetRightChildren(ref Children);
                            }
                        }
                    }

                    // Case13: Left vertical edge doesn't contains left of segment and right vertical edge contain right of segment
                    else if (rightVertex.X == interTrap.Rightp.X)
                    {
                        Node Children = ((TrapezoidalNode)interTrap.Node).To3TrapsCenterRight(newsegment);
                        foreach (Node parent in interTrap.Node.Parent)
                        {
                            if (parent.LeftChildren.IsTrapezoid && ((TrapezoidalNode)parent.LeftChildren).Trapezoid.Equals(interTrap))
                            {
                                parent.SetLeftChildren(ref Children);
                            }
                            else
                            {
                                parent.SetRightChildren(ref Children);
                            }
                        }
                    }

                    // Case14: Left vertical edge doesn't contains left of segment and right vertical edge doesn't contain right of segment
                    else
                    {
                        Node Children = ((TrapezoidalNode)interTrap.Node).To4Traps(newsegment);
                        if (interTrap.Node.Parent.Count != 0)
                        {
                            foreach (Node parent in interTrap.Node.Parent)
                            {
                                if (parent.LeftChildren.IsTrapezoid && ((TrapezoidalNode)parent.LeftChildren).Trapezoid.Equals(interTrap))
                                {
                                    parent.SetLeftChildren(ref Children);
                                }
                                else
                                {
                                    parent.SetRightChildren(ref Children);
                                }
                            }
                        }
                        else
                        {
                            Root = Children;
                        }
                    }
                }

                //
                // SECTION 2: many trapezoids intersect segment
                //

                else
                {
                    List <int>  WaitTraps       = new List <int>();
                    bool        HigherTrapsWait = false;
                    bool        LowerTrapsWait  = false;
                    List <Node> ListChildrens   = new List <Node>();
                    bool        FirstExcess     = false;
                    bool        LastExcess      = false;

                    // First trapezoid

                    Trapezoid FirstTrap     = ListInterTraps[0];
                    Node      FirstChildren = new Node();
                    // Case 1: Top contains left of segment
                    if (FirstTrap.Top.LeftVertex.Equals(newsegment.LeftVertex))
                    {
                        FirstChildren = ((TrapezoidalNode)FirstTrap.Node).To2TrapsTopLeft(newsegment);
                        if (FirstTrap.Top.RightVertex.Equals(FirstTrap.Rightp))
                        {
                            ((TrapezoidalNode)FirstChildren.LeftChildren).Trapezoid.SetVertex(newsegment.LeftVertex, FirstTrap.Rightp);
                            ((TrapezoidalNode)FirstChildren.RightChildren).Trapezoid.SetVertex(newsegment.LeftVertex, null);
                        }
                        else
                        {
                            ((TrapezoidalNode)FirstChildren.RightChildren).Trapezoid.SetVertex(newsegment.LeftVertex, FirstTrap.Rightp);
                            ((TrapezoidalNode)FirstChildren.LeftChildren).Trapezoid.SetVertex(newsegment.LeftVertex, null);
                        }
                        ListChildrens.Add(FirstChildren);
                    }
                    // Case 2: Bottom contains left of segment
                    else if (FirstTrap.Bottom.LeftVertex.Equals(newsegment.LeftVertex))
                    {
                        FirstChildren = ((TrapezoidalNode)FirstTrap.Node).To2TrapsBottomLeft(newsegment);
                        if (FirstTrap.Top.RightVertex.Equals(FirstTrap.Rightp))
                        {
                            ((TrapezoidalNode)FirstChildren.LeftChildren).Trapezoid.SetVertex(newsegment.LeftVertex, FirstTrap.Rightp);
                            ((TrapezoidalNode)FirstChildren.RightChildren).Trapezoid.SetVertex(newsegment.LeftVertex, null);
                        }
                        else
                        {
                            ((TrapezoidalNode)FirstChildren.RightChildren).Trapezoid.SetVertex(newsegment.LeftVertex, FirstTrap.Rightp);
                            ((TrapezoidalNode)FirstChildren.LeftChildren).Trapezoid.SetVertex(newsegment.LeftVertex, null);
                        }
                        ListChildrens.Add(FirstChildren);
                    }
                    // Case 3:  Left vertical edge contains left of segment
                    else if (FirstTrap.Leftp.X == newsegment.LeftVertex.X)
                    {
                        FirstChildren = ((TrapezoidalNode)FirstTrap.Node).To2TrapsCenterLeft(newsegment);
                        if (FirstTrap.Top.RightVertex.Equals(FirstTrap.Rightp))
                        {
                            ((TrapezoidalNode)FirstChildren.LeftChildren).Trapezoid.SetVertex(newsegment.LeftVertex, FirstTrap.Rightp);
                            ((TrapezoidalNode)FirstChildren.RightChildren).Trapezoid.SetVertex(newsegment.LeftVertex, null);
                        }
                        else
                        {
                            ((TrapezoidalNode)FirstChildren.RightChildren).Trapezoid.SetVertex(newsegment.LeftVertex, FirstTrap.Rightp);
                            ((TrapezoidalNode)FirstChildren.LeftChildren).Trapezoid.SetVertex(newsegment.LeftVertex, null);
                        }
                        ListChildrens.Add(FirstChildren);
                    }
                    // Case 4:  Left vertical edge doesn't contain left of segment
                    else
                    {
                        FirstChildren = ((TrapezoidalNode)FirstTrap.Node).To3TrapsLeft_2Right(newsegment);
                        FirstExcess   = true;
                        if (FirstTrap.Top.RightVertex.Equals(FirstTrap.Rightp))
                        {
                            ((TrapezoidalNode)FirstChildren.RightChildren.LeftChildren).Trapezoid.SetVertex(newsegment.LeftVertex, FirstTrap.Rightp);
                            ((TrapezoidalNode)FirstChildren.RightChildren.RightChildren).Trapezoid.SetVertex(newsegment.LeftVertex, null);
                        }
                        else
                        {
                            ((TrapezoidalNode)FirstChildren.RightChildren.RightChildren).Trapezoid.SetVertex(newsegment.LeftVertex, FirstTrap.Rightp);
                            ((TrapezoidalNode)FirstChildren.RightChildren.LeftChildren).Trapezoid.SetVertex(newsegment.LeftVertex, null);
                        }
                        ListChildrens.Add(FirstChildren.RightChildren);
                    }

                    // Middle trapezoids

                    for (int j = 1; j < ListInterTraps.Count - 1; j++)
                    {
                        Trapezoid MidTrap     = ListInterTraps[j];
                        Node      MidChildren = ((TrapezoidalNode)MidTrap.Node).To2Traps(newsegment);

                        if (MidTrap.Top.LeftVertex.Equals(MidTrap.Leftp))
                        {
                            ((TrapezoidalNode)MidChildren.LeftChildren).Trapezoid.SetLeftVertex(MidTrap.Leftp);
                            ((TrapezoidalNode)MidChildren.RightChildren).Trapezoid.SetLeftVertex(null);
                        }
                        else
                        {
                            ((TrapezoidalNode)MidChildren.RightChildren).Trapezoid.SetLeftVertex(MidTrap.Leftp);
                            ((TrapezoidalNode)MidChildren.LeftChildren).Trapezoid.SetLeftVertex(null);
                        }

                        if (MidTrap.Top.RightVertex.Equals(MidTrap.Rightp))
                        {
                            ((TrapezoidalNode)MidChildren.LeftChildren).Trapezoid.SetRightVertex(MidTrap.Rightp);
                            ((TrapezoidalNode)MidChildren.RightChildren).Trapezoid.SetRightVertex(null);
                        }
                        else
                        {
                            ((TrapezoidalNode)MidChildren.RightChildren).Trapezoid.SetRightVertex(MidTrap.Rightp);
                            ((TrapezoidalNode)MidChildren.LeftChildren).Trapezoid.SetRightVertex(null);
                        }
                        ListChildrens.Add(MidChildren);
                    }

                    // Last trapezoid

                    Trapezoid LastTrap     = ListInterTraps.Last();
                    Node      LastChildren = new Node();
                    // Case 1: Top contains right of segment
                    if (LastTrap.Top.RightVertex.Equals(newsegment.RightVertex))
                    {
                        LastChildren = ((TrapezoidalNode)LastTrap.Node).To2TrapsTopRight(newsegment);
                        if (LastTrap.Top.LeftVertex.Equals(LastTrap.Leftp))
                        {
                            ((TrapezoidalNode)LastChildren.LeftChildren).Trapezoid.SetVertex(LastTrap.Leftp, newsegment.RightVertex);
                            ((TrapezoidalNode)LastChildren.RightChildren).Trapezoid.SetVertex(null, newsegment.RightVertex);
                        }
                        else
                        {
                            ((TrapezoidalNode)LastChildren.RightChildren).Trapezoid.SetVertex(LastTrap.Leftp, newsegment.RightVertex);
                            ((TrapezoidalNode)LastChildren.LeftChildren).Trapezoid.SetVertex(null, newsegment.RightVertex);
                        }
                        ListChildrens.Add(LastChildren);
                    }
                    // Case 2: Bottom contains right of segment
                    else if (LastTrap.Bottom.RightVertex.Equals(newsegment.RightVertex))
                    {
                        LastChildren = ((TrapezoidalNode)LastTrap.Node).To2TrapsBottomRight(newsegment);
                        if (LastTrap.Top.LeftVertex.Equals(LastTrap.Leftp))
                        {
                            ((TrapezoidalNode)LastChildren.LeftChildren).Trapezoid.SetVertex(LastTrap.Leftp, newsegment.RightVertex);
                            ((TrapezoidalNode)LastChildren.RightChildren).Trapezoid.SetVertex(null, newsegment.RightVertex);
                        }
                        else
                        {
                            ((TrapezoidalNode)LastChildren.RightChildren).Trapezoid.SetVertex(LastTrap.Leftp, newsegment.RightVertex);
                            ((TrapezoidalNode)LastChildren.LeftChildren).Trapezoid.SetVertex(null, newsegment.RightVertex);
                        }
                        ListChildrens.Add(LastChildren);
                    }
                    // Case 3:  Left vertical edge contains right of segment
                    else if (LastTrap.Rightp.X == newsegment.RightVertex.X)
                    {
                        LastChildren = ((TrapezoidalNode)LastTrap.Node).To2TrapsCenterRight(newsegment);
                        if (LastTrap.Top.LeftVertex.Equals(LastTrap.Leftp))
                        {
                            ((TrapezoidalNode)LastChildren.LeftChildren).Trapezoid.SetVertex(LastTrap.Leftp, newsegment.RightVertex);
                            ((TrapezoidalNode)LastChildren.RightChildren).Trapezoid.SetVertex(null, newsegment.RightVertex);
                        }
                        else
                        {
                            ((TrapezoidalNode)LastChildren.RightChildren).Trapezoid.SetVertex(LastTrap.Leftp, newsegment.RightVertex);
                            ((TrapezoidalNode)LastChildren.LeftChildren).Trapezoid.SetVertex(null, newsegment.RightVertex);
                        }
                        ListChildrens.Add(LastChildren);
                    }
                    // Case 4:  Left vertical edge doesn't contain left of segment
                    else
                    {
                        LastChildren = ((TrapezoidalNode)LastTrap.Node).To3TrapsRight_2Left(newsegment);
                        LastExcess   = true;
                        if (LastTrap.Top.LeftVertex.Equals(LastTrap.Leftp))
                        {
                            ((TrapezoidalNode)LastChildren.LeftChildren.LeftChildren).Trapezoid.SetVertex(LastTrap.Leftp, newsegment.RightVertex);
                            ((TrapezoidalNode)LastChildren.LeftChildren.RightChildren).Trapezoid.SetVertex(null, newsegment.RightVertex);
                        }
                        else
                        {
                            ((TrapezoidalNode)LastChildren.LeftChildren.RightChildren).Trapezoid.SetVertex(LastTrap.Leftp, newsegment.RightVertex);
                            ((TrapezoidalNode)LastChildren.LeftChildren.LeftChildren).Trapezoid.SetVertex(null, newsegment.RightVertex);
                        }
                        ListChildrens.Add(LastChildren.LeftChildren);
                    }

                    ((TrapezoidalNode)ListChildrens[0].LeftChildren).Trapezoid.SetRightNeighbor(((TrapezoidalNode)ListChildrens[1].LeftChildren).Trapezoid, ((TrapezoidalNode)ListChildrens[1].LeftChildren).Trapezoid);
                    ((TrapezoidalNode)ListChildrens[0].RightChildren).Trapezoid.SetRightNeighbor(((TrapezoidalNode)ListChildrens[1].RightChildren).Trapezoid, ((TrapezoidalNode)ListChildrens[1].RightChildren).Trapezoid);

                    ((TrapezoidalNode)ListChildrens.Last().LeftChildren).Trapezoid.SetLeftNeighbor(((TrapezoidalNode)ListChildrens[ListChildrens.Count - 2].LeftChildren).Trapezoid, ((TrapezoidalNode)ListChildrens[ListChildrens.Count - 2].LeftChildren).Trapezoid);
                    ((TrapezoidalNode)ListChildrens.Last().RightChildren).Trapezoid.SetLeftNeighbor(((TrapezoidalNode)ListChildrens[ListChildrens.Count - 2].RightChildren).Trapezoid, ((TrapezoidalNode)ListChildrens[ListChildrens.Count - 2].RightChildren).Trapezoid);

                    for (int j = 1; j < ListChildrens.Count - 1; j++)
                    {
                        ((TrapezoidalNode)ListChildrens[j].LeftChildren).Trapezoid.SetRightNeighbor(((TrapezoidalNode)ListChildrens[j + 1].LeftChildren).Trapezoid, ((TrapezoidalNode)ListChildrens[j + 1].LeftChildren).Trapezoid);
                        ((TrapezoidalNode)ListChildrens[j].RightChildren).Trapezoid.SetRightNeighbor(((TrapezoidalNode)ListChildrens[j + 1].RightChildren).Trapezoid, ((TrapezoidalNode)ListChildrens[j + 1].RightChildren).Trapezoid);
                        ((TrapezoidalNode)ListChildrens[j].LeftChildren).Trapezoid.SetLeftNeighbor(((TrapezoidalNode)ListChildrens[j - 1].LeftChildren).Trapezoid, ((TrapezoidalNode)ListChildrens[j + 1].LeftChildren).Trapezoid);
                        ((TrapezoidalNode)ListChildrens[j].RightChildren).Trapezoid.SetLeftNeighbor(((TrapezoidalNode)ListChildrens[j - 1].RightChildren).Trapezoid, ((TrapezoidalNode)ListChildrens[j + 1].RightChildren).Trapezoid);
                    }

                    bool continueCheck = true;
                    while (continueCheck)
                    {
                        continueCheck = false;
                        for (int j = 0; j < ListChildrens.Count - 1; j++)
                        {
                            if (((TrapezoidalNode)ListChildrens[j].LeftChildren).Trapezoid.Rightp == null)
                            {
                                continueCheck = true;
                                Trapezoid oldLeftTrap  = ((TrapezoidalNode)ListChildrens[j].LeftChildren).Trapezoid;
                                Trapezoid oldRightTrap = ((TrapezoidalNode)ListChildrens[j + 1].LeftChildren).Trapezoid;
                                Trapezoid newTrap      = new Trapezoid(oldLeftTrap.Leftp, oldRightTrap.Rightp, oldLeftTrap.Top, oldLeftTrap.Bottom);
                                newTrap.SetNeighbor(oldLeftTrap.HigherLeftNeighbor, oldLeftTrap.LowerLeftNeighbor, oldRightTrap.HigherRightNeighbor, oldRightTrap.LowerRightNeighbor);
                                TrapezoidalNode newNode = new TrapezoidalNode(newTrap);
                                ListChildrens[j].LeftChildren     = newNode;
                                ListChildrens[j + 1].LeftChildren = newNode;
                            }

                            if (((TrapezoidalNode)ListChildrens[j].RightChildren).Trapezoid.Rightp == null)
                            {
                                continueCheck = true;
                                Trapezoid oldLeftTrap  = ((TrapezoidalNode)ListChildrens[j].RightChildren).Trapezoid;
                                Trapezoid oldRightTrap = ((TrapezoidalNode)ListChildrens[j + 1].RightChildren).Trapezoid;
                                Trapezoid newTrap      = new Trapezoid(oldLeftTrap.Leftp, oldRightTrap.Rightp, oldLeftTrap.Top, oldLeftTrap.Bottom);
                                newTrap.SetNeighbor(oldLeftTrap.HigherLeftNeighbor, oldLeftTrap.LowerLeftNeighbor, oldRightTrap.HigherRightNeighbor, oldRightTrap.LowerRightNeighbor);
                                TrapezoidalNode newNode = new TrapezoidalNode(newTrap);
                                ListChildrens[j].RightChildren     = newNode;
                                ListChildrens[j + 1].RightChildren = newNode;
                            }
                        }
                    }
                }
            }
        }