TrBreaklineAdder.cpp

Go to the documentation of this file.

//------------------------------------------------------------------------------
//------------------------------------------------------------------------------

//----- Included files ---------------------------------------------------------

// 1. Precompiled header

// 2. My own header
#include <xmsgeom/triangulate/TrBreaklineAdder.h>

// 3. Standard library headers
#include <functional>

// 4. External library headers

// 5. Shared code headers
#include <xmscore/stl/set.h>
#include <xmscore/stl/vector.h>
#include <xmsgeom/geometry/geoms.h>
#include <xmsgeom/geometry/GmBoostTypes.h>
#include <xmsgeom/geometry/GmPtSearch.h>
#include <xmsgeom/geometry/GmMultiPolyIntersector.h>
#include <xmsgeom/geometry/GmMultiPolyIntersectionSorterTerse.h>
#include <xmscore/misc/Observer.h>
#include <xmsgeom/triangulate/triangles.h>
#include <xmsgeom/triangulate/TrTin.h>
#include <xmscore/misc/XmError.h>

// 6. Non-shared code headers

//----- Namespace declaration --------------------------------------------------

namespace xms
{
//----- Forward declarations ---------------------------------------------------

//----- External globals -------------------------------------------------------

//----- Constants / Enumerations -----------------------------------------------

//----- Classes / Structs ------------------------------------------------------

struct edgerecord
{
  int pt1;           
  int pt2;           
  Pt3d intersection; 
};

typedef std::vector<edgerecord> VecEdge; 

class TrBreaklineAdderImpl : public TrBreaklineAdder
{
public:
  TrBreaklineAdderImpl();
  virtual ~TrBreaklineAdderImpl();

  virtual void SetObserver(BSHP<Observer> a_) override { m_observer = a_; }
  virtual void SetTin(BSHP<TrTin> a_tin, double a_tol = -1) override;
  virtual void AddBreakline(const VecInt& a_breakline) override;
  virtual void AddBreaklines(const VecInt2d& a_breakline) override;
  virtual std::string ErrorMessage(int) const override;

private:
  bool GetExtents();
  void ComputeTolerance();
  bool CrossesBoundary(int a_blpt1, int a_blpt2);
  void ProcessSegmentBySwapping(int a_vtx1, int a_vtx2);
  void GetIntersectingEdges(int a_blpt1, int a_blpt2, VecEdge& a_edges);
  void FindIntersectingEdgeFromPoint(int a_blpt1,
                                     int a_blpt2,
                                     int* a_intpt1,
                                     int* a_intpt2,
                                     double* a_x,
                                     double* a_y,
                                     double* a_z1,
                                     double* a_z2);
  void FindIntersectingEdgeFromEdge(int a_ept1,
                                    int a_ept2,
                                    int a_blpt1,
                                    int a_blpt2,
                                    int* a_intpt1,
                                    int* a_intpt2,
                                    double* a_x,
                                    double* a_y,
                                    double* a_z1,
                                    double* a_z2);

  BSHP<TrTin> m_tin;         
  BSHP<Observer> m_observer; 
  double m_xyTol;            
  size_t m_totNumSegs;       
  size_t m_segCount;         
  VecInt* m_tris;            
  VecPt3d* m_pts;            
  VecInt2d* m_trisAdjToPts;  
  Pt3d m_mn;                 
  Pt3d m_mx;                 
  BSHP<GmMultiPolyIntersector>
    m_multiPolyIntersector;    
  BSHP<GmPtSearch> m_searcher; 
};                             // class TrBreaklineAdderImpl

//----- Internal functions -----------------------------------------------------

//----- Class / Function definitions -------------------------------------------

//------------------------------------------------------------------------------
//------------------------------------------------------------------------------
TrBreaklineAdderImpl::TrBreaklineAdderImpl()
: m_tin()
, m_observer()
, m_xyTol(1e-9)
, m_totNumSegs(0)
, m_segCount(0)
, m_tris(nullptr)
, m_pts(nullptr)
, m_trisAdjToPts(nullptr)
, m_mn()
, m_mx()
, m_multiPolyIntersector()
, m_searcher()
{
}
//------------------------------------------------------------------------------
//------------------------------------------------------------------------------
TrBreaklineAdderImpl::~TrBreaklineAdderImpl()
{
}
//------------------------------------------------------------------------------
//------------------------------------------------------------------------------
void TrBreaklineAdderImpl::SetTin(BSHP<TrTin> a_tin, double a_tol /*-1*/)
{
  m_tin = a_tin;

  // Check for an invalid tin
  XM_ENSURE_TRUE_T_NO_ASSERT(m_tin, std::runtime_error("Tin is null."));
  // XM_ENSURE_TRUE_T_NO_ASSERT(!m_tin->Triangles().empty(), std::runtime_error("Tin has no
  // triangles."));  XM_ENSURE_TRUE_T_NO_ASSERT(!m_tin->Points().empty(), std::runtime_error("Tin
  // has no points."));  XM_ENSURE_TRUE_T_NO_ASSERT(!m_tin->TrisAdjToPts().empty(),
  //                 std::runtime_error("Tin has no adjacency info."));

  m_tris = &m_tin->Triangles();
  m_pts = &m_tin->Points();
  m_trisAdjToPts = &m_tin->TrisAdjToPts();
  if (a_tol < 0)
  {
    ComputeTolerance();
  }
  else
  {
    m_xyTol = a_tol;
  }
} // TrBreaklineAdderImpl::SetTin
//------------------------------------------------------------------------------
//------------------------------------------------------------------------------
void TrBreaklineAdderImpl::AddBreakline(const VecInt& a_breakline)
{
  XM_ENSURE_TRUE_T_NO_ASSERT(m_tin, std::runtime_error("No tin set in TrBreaklineAdder."));

  bool progressStarted = false;
  if (m_observer)
  {
    if (m_totNumSegs < 1)
    {
      m_observer->BeginOperationString("Adding Breaklines");
      progressStarted = true;
      m_totNumSegs = a_breakline.size() - 1;
      m_segCount = 0;
    }
  }

  for (size_t pt = 1; pt < a_breakline.size(); ++pt)
  {
    int pt1 = a_breakline[pt - 1];
    int pt2 = a_breakline[pt];
    if (!m_tin->VerticesAreAdjacent(pt1, pt2))
    {
      ProcessSegmentBySwapping(pt1, pt2);
    }
    if (m_observer)
    {
      m_observer->ProgressStatus(m_segCount / (double)m_totNumSegs);
      m_segCount++;
    }
  }

  if (m_observer && progressStarted)
  {
    m_observer->EndOperation();
  }

} // TrBreaklineAdderImpl::AddBreakline
//------------------------------------------------------------------------------
//------------------------------------------------------------------------------
void TrBreaklineAdderImpl::AddBreaklines(const VecInt2d& a_breaklines)
{
  XM_ENSURE_TRUE_T_NO_ASSERT(m_tin, std::runtime_error("No tin set in TrBreaklineAdder."));

  if (m_observer)
  {
    m_observer->BeginOperationString("Adding Breaklines");
    m_segCount = 0;
    m_totNumSegs = 0;
    for (size_t i = 0; i < a_breaklines.size(); ++i)
    {
      m_totNumSegs += a_breaklines[i].size() - 1;
    }
  }

  for (size_t i = 0; i < a_breaklines.size(); ++i)
  {
    AddBreakline(a_breaklines[i]);
  }

  m_segCount = 0;
  m_totNumSegs = 0;

  if (m_observer)
  {
    m_observer->EndOperation();
  }
} // TrBreaklineAdderImpl::AddBreaklines
//------------------------------------------------------------------------------
//------------------------------------------------------------------------------
std::string TrBreaklineAdderImpl::ErrorMessage(int a_messageNumber) const
{
  std::string message;
  switch (a_messageNumber)
  {
  case 0:
    message = "One or more breakline segments intersected a boundary and was ignored.";
    break;
  default:
    XM_ASSERT(false);
    break;
  }
  return message;
} // TrBreaklineAdderImpl::ErrorMessage
//------------------------------------------------------------------------------
//------------------------------------------------------------------------------
bool TrBreaklineAdderImpl::CrossesBoundary(int a_blpt1, int a_blpt2)
{
  //#if 0
  if (!m_multiPolyIntersector)
  {
    VecInt2d boundaryPolys;
    m_tin->GetBoundaryPolys(boundaryPolys);

    BSHP<GmMultiPolyIntersectionSorter> sorter =
      BSHP<GmMultiPolyIntersectionSorter>(new GmMultiPolyIntersectionSorterTerse());
    m_multiPolyIntersector = GmMultiPolyIntersector::New(m_tin->Points(), boundaryPolys, sorter);
    m_multiPolyIntersector->SetQuery(GMMPIQ_INTERSECTS);

    m_searcher = GmPtSearch::New(true);
    m_searcher->PtsToSearch(m_tin->PointsPtr());
  }

  VecInt intersectedPolys;
  VecPt3d intersectionPts;
  m_multiPolyIntersector->TraverseLineSegment(
    m_tin->Points()[a_blpt1].x, m_tin->Points()[a_blpt1].y, m_tin->Points()[a_blpt2].x,
    m_tin->Points()[a_blpt2].y, intersectedPolys, intersectionPts);
  if (intersectedPolys.empty())
  {
    return false;
  }
  else
  {
    // See if the intersectionPts are at the boundary points. If so, we aren't
    // crossing an edge.
    for (size_t i = 0; i < intersectionPts.size(); ++i)
    {
      if (!m_searcher->PtInRTree(intersectionPts[i], m_xyTol))
      {
        return true;
      }
    }
  }
  //#endif
  return false;
} // TrBreaklineAdderImpl::CrossesBoundary
//------------------------------------------------------------------------------
//------------------------------------------------------------------------------
void TrBreaklineAdderImpl::ProcessSegmentBySwapping(int a_blpt1, int a_blpt2)
{
  if (CrossesBoundary(a_blpt1, a_blpt2))
  {
    XM_LOG(xmlog::warning,
           "One or more breakline segments intersected a boundary and was ignored.");
    return;
  }

  VecEdge edges;
  GetIntersectingEdges(a_blpt1, a_blpt2, edges);
  VecEdge::iterator edge = edges.begin();

  bool good_tris = true;
  bool trisSwappedThisPass = false;
  double x, y, z1, z2;

  while (!edges.empty() && edge != edges.end())
  {
    int tri1 = m_tin->TriangleAdjacentToEdge(edge->pt1, edge->pt2);
    int tri2 = m_tin->TriangleAdjacentToEdge(edge->pt2, edge->pt1);
    if (!m_tin->SwapEdge(tri1, tri2, good_tris))
    {
      ++edge;
    }
    else
    {
      trisSwappedThisPass = true;
      // See if new edge needs to be put on the list
      int index = m_tin->CommonEdgeIndex(tri1, tri2);
      // 'unsigned int', possible loss of data
      int newpt1 = (*m_tris)[(tri1 * 3) + index];
      index = trIncrementIndex(index);
      int newpt2 = (*m_tris)[(tri1 * 3) + index];
      if ((newpt1 != a_blpt1) && (newpt1 != a_blpt2) && (newpt2 != a_blpt1) &&
          (newpt2 != a_blpt2) &&
          gmIntersectLineSegmentsWithTol((*m_pts)[a_blpt1], (*m_pts)[a_blpt2], (*m_pts)[newpt1],
                                         (*m_pts)[newpt2], &x, &y, &z1, &z2, m_xyTol))
      {
        // put edge on the list in place of swapped one
        edge->pt1 = newpt1;
        edge->pt2 = newpt2;
        ++edge;
      }
      else
      {
        // Remove this edge from the list
        edge = edges.erase(edge);
      }
    }
    // if we are still not adjacent
    if (edge == edges.end() && (tri1 != -1 && tri2 != -1))
    {
      // if we didn't do any swaps continue through list again
      if (!trisSwappedThisPass)
      {
        if (good_tris)
        {
          good_tris = false;
        }
        else
        {
          break;
        }
      }
      // There is a potential for infinite loop.  This is where we could check for that
      // We did some swapping or we removed triangle criterion - try starting over with the edge
      // list
      edge = edges.begin();
      trisSwappedThisPass = false;
    }
    else if (m_tin->VerticesAreAdjacent(a_blpt1, a_blpt2))
      break;
    // if (xgCheckEscape()) {
    //  throw exceptions::Exception("User Escape");
    //}
  }
} // TrBreaklineAdderImpl::ProcessSegmentBySwapping
//------------------------------------------------------------------------------
//------------------------------------------------------------------------------
void TrBreaklineAdderImpl::GetIntersectingEdges(int a_blpt1, int a_blpt2, VecEdge& a_edges)
{
  bool first = true;
  bool done = false;
  int intpt1, intpt2;
  double x, y, z1, z2;
  do
  {
    if (first)
    {
      FindIntersectingEdgeFromPoint(a_blpt1, a_blpt2, &intpt1, &intpt2, &x, &y, &z1, &z2);
      first = false;
    }
    else
    {
      FindIntersectingEdgeFromEdge(intpt2, intpt1, a_blpt1, a_blpt2, &intpt1, &intpt2, &x, &y, &z1,
                                   &z2);
    }
    if (intpt1 == -1 || intpt2 == -1)
      done = true;
    else if (intpt1 == a_blpt2 || intpt2 == a_blpt2)
      done = true;
    else
    {
      edgerecord edge;
      edge.pt1 = intpt1;
      edge.pt2 = intpt2;
      edge.intersection.x = x;
      edge.intersection.y = y;
      edge.intersection.z = z2;
      a_edges.push_back(edge);
    }
  } while (!done);

} // TrBreaklineAdderImpl::GetIntersectingEdges
//------------------------------------------------------------------------------
//------------------------------------------------------------------------------
void TrBreaklineAdderImpl::FindIntersectingEdgeFromPoint(int a_blpt1,
                                                         int a_blpt2,
                                                         int* a_intpt1,
                                                         int* a_intpt2,
                                                         double* a_x,
                                                         double* a_y,
                                                         double* a_z1,
                                                         double* a_z2)
{
  // loop thru adjacent tris until found
  bool found = false;
  // 'unsigned int', possible loss of data
  for (size_t adjTri = 0; adjTri < (*m_trisAdjToPts)[a_blpt1].size() && !found; ++adjTri)
  {
    int tri = (*m_trisAdjToPts)[a_blpt1][adjTri];
    // Check opposite edge(s) for intersections
    int localIdx1 = m_tin->LocalIndex(tri, a_blpt1);
    localIdx1 = trIncrementIndex(localIdx1);
    int localIdx2 = trIncrementIndex(localIdx1);
    *a_intpt1 = m_tin->Triangles()[(tri * 3) + localIdx1];
    *a_intpt2 = m_tin->Triangles()[(tri * 3) + localIdx2];
    found =
      gmIntersectLineSegmentsWithTol((*m_pts)[a_blpt1], (*m_pts)[a_blpt2], (*m_pts)[*a_intpt1],
                                     (*m_pts)[*a_intpt2], a_x, a_y, a_z1, a_z2, m_xyTol);
  }
  if (!found)
  {
    *a_intpt1 = *a_intpt2 = -1;
  }

} // TrBreaklineAdderImpl::FindIntersectingEdgeFromPoint
//------------------------------------------------------------------------------
//------------------------------------------------------------------------------
void TrBreaklineAdderImpl::FindIntersectingEdgeFromEdge(int a_ept1,
                                                        int a_ept2,
                                                        int a_blpt1,
                                                        int a_blpt2,
                                                        int* a_intpt1,
                                                        int* a_intpt2,
                                                        double* a_x,
                                                        double* a_y,
                                                        double* a_z1,
                                                        double* a_z2)
{
  bool found = false;
  int tri = m_tin->TriangleAdjacentToEdge(a_ept2, a_ept1);
  XM_ENSURE_TRUE_T_NO_ASSERT(tri != -1, std::runtime_error("Void in breakline"));

  int localIdx1 = m_tin->LocalIndex(tri, a_ept2);
  const int kNumcorners = 3;
  int crnrid;
  int count;
  for (crnrid = localIdx1, count = 1; !found && count <= kNumcorners - 1; count++)
  {
    int nextid = trIncrementIndex(crnrid);
    int trisIdx = tri * 3;
    *a_intpt1 = (*m_tris)[trisIdx + crnrid];
    *a_intpt2 = (*m_tris)[trisIdx + nextid];
    found =
      gmIntersectLineSegmentsWithTol((*m_pts)[a_blpt1], (*m_pts)[a_blpt2], (*m_pts)[*a_intpt1],
                                     (*m_pts)[*a_intpt2], a_x, a_y, a_z1, a_z2, m_xyTol);
    if (found)
    {
      int adjTri = -1;
      int id1, id2;
      m_tin->TriangleFromEdge(*a_intpt1, *a_intpt2, adjTri, id1, id2);
      if (adjTri == -1)
      {
        throw std::runtime_error("Void in breakline");
      }
    }
    crnrid = nextid;
  }

  if (!found)
  {
    *a_intpt1 = *a_intpt2 = -1;
  }

} // TrBreaklineAdderImpl::FindIntersectingEdgeFromEdge
//------------------------------------------------------------------------------
//------------------------------------------------------------------------------
bool TrBreaklineAdderImpl::GetExtents()
{
  if (m_tin)
  {
    return m_tin->GetExtents(m_mn, m_mx);
  }
  return false;
} // TrBreaklineAdderImpl::GetExtents
//------------------------------------------------------------------------------
//------------------------------------------------------------------------------
void TrBreaklineAdderImpl::ComputeTolerance()
{
  if (GetExtents())
  {
    m_xyTol = gmComputeXyTol(m_mn, m_mx);
  }
} // TrBreaklineAdderImpl::ComputeTolerance

//------------------------------------------------------------------------------
//------------------------------------------------------------------------------
TrBreaklineAdder::TrBreaklineAdder()
{
}
//------------------------------------------------------------------------------
//------------------------------------------------------------------------------
TrBreaklineAdder::~TrBreaklineAdder()
{
}
//------------------------------------------------------------------------------
//------------------------------------------------------------------------------
BSHP<TrBreaklineAdder> TrBreaklineAdder::New()
{
  return BDPC<TrBreaklineAdder>(BSHP<TrBreaklineAdderImpl>(new TrBreaklineAdderImpl()));
} // TrBreaklineAdder::TrBreaklineAdder

} // namespace xms

// TESTS
#ifdef CXX_TEST

#include <xmsgeom/triangulate/TrBreaklineAdder.t.h>

#include <boost/assign.hpp>

#include <xmscore/testing/TestTools.h>
#include <xmscore/misc/carray.h>
#include <xmsgeom/triangulate/TrTriangulatorPoints.h>
#include <xmsgeom/triangulate/TrTin.t.h>

//----- Namespace declaration --------------------------------------------------

// namespace xms {
using namespace xms;

//------------------------------------------------------------------------------
//  Before
//
//  4-          3---------------4
//   |        / | \           / | \
//   |      /   |   \   5   /   |   \
//   |    /     |     \   /     |     \
//  0-  0    0  |  1    1    2  |  4    2
//   |    \     |     /   \     |     /
//   |      \   |   /   3   \   |   /
//   |        \ | /           \ | /
// -4-          5-------------- 6
//
//      |-------|-------|-------|-------|
//      0       5      10      15      20
//
//  After
//
//  4-          3---------------4
//   |        / | \           /   \
//   |      /   |   \   5   /   2   \
//   |    /     |     \   /           \
//  0-  0    0  |  1    1---------------2
//   |    \     |     /   \           /
//   |      \   |   /   3   \   4   /
//   |        \ | /           \   /
// -4-          5-------------- 6
//
//      |-------|-------|-------|-------|
//      0       5      10      15      20
//------------------------------------------------------------------------------
void TrBreaklineAdderUnitTests::test1()
{
  // Set up the tin
  BSHP<TrTin> tin = TrTin::New();
  tin->Points() = {{0, 0, 0},  {10, 0, 0}, {20, 0, 0}, {5, 4, 0},
                   {15, 4, 0}, {5, -4, 0}, {15, -4, 0}};
  TrTriangulatorPoints triangulator(tin->Points(), tin->Triangles(), &tin->TrisAdjToPts());
  triangulator.Triangulate();

  // Verify triangles before
  int trisB[] = {0, 5, 3, 3, 5, 1, 1, 6, 4, 6, 1, 5, 2, 4, 6, 1, 4, 3};
  TS_ASSERT_EQUALS(VecInt(&trisB[0], &trisB[18]), tin->Triangles());

  // Add breakline
  BSHP<TrBreaklineAdder> adder = TrBreaklineAdder::New();
  adder->SetTin(tin);
  VecInt outPoly = {0, 5, 6, 1, 2, 4, 3};
  adder->AddBreakline(outPoly);

  // Verify triangles after
  int trisA[] = {0, 5, 3, 3, 5, 1, 1, 2, 4, 6, 1, 5, 2, 1, 6, 1, 4, 3};
  TS_ASSERT_EQUALS(VecInt(&trisA[0], &trisA[XM_COUNTOF(trisA)]), tin->Triangles());

} // TrBreaklineAdderUnitTests::test1
//------------------------------------------------------------------------------
//  Before
//
//  10-  17-----18------19------20------21
//    |  |\  8  /|\ 11  /|\ 22  / \ 26  /|
//    |  | \   / | \   / | \   /   \   //|
//    |  |  \ /  |  \ /30|23\ / 27  \ / /|
//   5-  |6 13 12|9 14   |  15------16  /|
//    |  |  / \  |  /|\  |  / \ 25  /|28/|
//    |  | /   \ | / | \ | /   \   / | / |
//    |  |/  7  \|/  |  \|/ 24  \ /29| / |
//   0-  9------10 10|3 11------12   | / |
//    |  |\ 13  / \  |  / \ 15  / \  |/  |
//    |  | \   /   \ | /   \   /   \ |/  |
//    |  |  \ /  5  \|/ 16  \ / 21  \|/  |
//  -5-  | 0 5-------6-------7-------8 18|
//    |  |  / \  4  / \ 14  / \ 19  / \  |
//    |  | /   \   /   \   /   \   /   \ |
//    |  |/  1  \ /  2  \ / 20  \ / 17  \|
// -10-  0-------1-------2-------3-------4
//
//       |-------|-------|-------|-------|
//       0      10      20      30      40
//
//  After swapping
//
//  10-  17-----18------19------20------21
//    |  |\  8  / \ 11  /|\ 22  / \ 26  /|
//    |  | \   /   \   / | \   /   \   //|
//    |  |  \ / 12  \ /30|23\ / 27  \ / /|
//   5-  |6 13------14   |  15------16  /|
//    |  |  /|\  9  /|\  |  /|\ 25  /|28/|
//    |  | / | \   / | \ | / | \   / | / |
//    |  |/  |  \ /  |  \|/  |24\ /29| / |
//   0-  9 13|7 10 10|3 11 15|  12   | / |
//    |  |\  |  / \  |  / \  |  / \  |/  |
//    |  | \ | /   \ | /   \ | /   \ |/  |
//    |  |  \|/  5  \|/ 16  \|/ 21  \|/  |
//  -5-  | 0 5-------6-------7-------8 18|
//    |  |  / \  4  / \ 14  / \ 19  / \  |
//    |  | /   \   /   \   /   \   /   \ |
//    |  |/  1  \ /  2  \ / 20  \ / 17  \|
// -10-  0-------1-------2-------3-------4
//
//       |-------|-------|-------|-------|
//       0      10      20      30      40
//
//  After removing triangles (*** means a hole)
//
//  10-  17-----18------19------20------21
//    |  |\  7  / \  9  /|\ 17  / \ 21  /
//    |  | \   /   \   / | \   /   \   /
//    |  |  \ / 10  \ /24|18\ / 22  \ /
//   5-  |6 13------14   |  15------16
//    |  |  /|******/|\  |  /|\ 20  /|
//    |  | / |*****/ | \ | /*| \   / |
//    |  |/  |****/  |  \|/**|19\ /23|
//   0-  9 11|**10  8|3 11***|  12   |
//    |  |\  |**/ \  |  /****|  / \  |
//    |  | \ |*/   \ | /*****| /   \ |
//    |  |  \|/  5  \|/******|/ 16  \|
//  -5-  | 0 5-------6-------7-------8
//    |  |  / \  4  / \ 12  / \ 14  / \
//    |  | /   \   /   \   /   \   /   \
//    |  |/  1  \ /  2  \ / 15  \ / 13  \
// -10-  0-------1-------2-------3-------4
//
//       |-------|-------|-------|-------|
//       0      10      20      30      40
//------------------------------------------------------------------------------
void TrBreaklineAdderUnitTests::test2()
{
  // Set up tin
  BSHP<TrTin> tin = trBuildTestTin7();

  // Verify triangles before
  int trisB[] = {0,  5,  9,  5,  0,  1,  1,  2,  6,  14, 6,  11, 1,  6,  5,  5,  6,  10, 9,
                 13, 17, 13, 9,  10, 17, 13, 18, 10, 14, 18, 14, 10, 6,  18, 14, 19, 10, 18,
                 13, 9,  5,  10, 6,  2,  7,  12, 11, 7,  7,  11, 6,  3,  4,  8,  8,  4,  21,
                 3,  8,  7,  7,  2,  3,  12, 7,  8,  19, 15, 20, 15, 19, 11, 12, 15, 11, 15,
                 12, 16, 20, 16, 21, 16, 20, 15, 21, 16, 8,  12, 8,  16, 11, 19, 14};
  TS_ASSERT_EQUALS(VecInt(&trisB[0], &trisB[93]), tin->Triangles());

  // Set up polygons
  int outPolyA[] = {0, 1, 2, 3, 4, 8, 16, 21, 20, 19, 18, 17, 9};
  VecInt outPoly(&outPolyA[0], &outPolyA[13]);
  int inPoly1[] = {10, 5, 13, 14};
  int inPoly2[] = {6, 11, 15, 7};
  VecInt2d inPolys;
  inPolys.push_back(VecInt(&inPoly1[0], &inPoly1[4]));
  inPolys.push_back(VecInt(&inPoly2[0], &inPoly2[4]));

  // Add breaklines
  BSHP<TrBreaklineAdder> adder = TrBreaklineAdder::New();
  adder->SetTin(tin);
  adder->AddBreakline(outPoly);
  adder->AddBreaklines(inPolys);

  // Verify triangles after
  int trisA[] = {0,  5,  9,  5,  0,  1,  1,  2,  6,  14, 6,  11, 1,  6,  5,  5,  6,  10, 9,
                 13, 17, 13, 5,  10, 17, 13, 18, 10, 14, 13, 14, 10, 6,  18, 14, 19, 14, 18,
                 13, 9,  5,  13, 6,  2,  7,  15, 11, 7,  7,  11, 6,  3,  4,  8,  8,  4,  21,
                 3,  8,  7,  7,  2,  3,  12, 7,  8,  19, 15, 20, 15, 19, 11, 12, 15, 7,  15,
                 12, 16, 20, 16, 21, 16, 20, 15, 21, 16, 8,  12, 8,  16, 11, 19, 14};
  VecInt trisAfter(&trisA[0], &trisA[XM_COUNTOF(trisA)]);
  TS_ASSERT_EQUALS(trisAfter, tin->Triangles());

} // TrBreaklineAdderUnitTests::test2
//------------------------------------------------------------------------------
//
//------------------------------------------------------------------------------
void TrBreaklineAdderUnitTests::testCrossingBoundary()
{
  try
  {
    BSHP<TrTin> tin = trBuildTestTin8();

    // Add breakline
    BSHP<TrBreaklineAdder> adder = TrBreaklineAdder::New();
    adder->SetTin(tin);

    // Copy triangles before
    VecInt tris = tin->Triangles();

    std::string errorMessage = adder->ErrorMessage(0);

    // Try to add a breakline that crosses the hole
    VecInt breakline = {3, 8};
    XmLog::Instance().GetAndClearStackStr();
    adder->AddBreakline(breakline);
    TS_ASSERT(XmLog::Instance().ErrCount() == 1);
    if (XmLog::Instance().ErrCount() > 0)
    {
      MessageStack messages = XmLog::Instance().GetAndClearStack();
      TS_ASSERT_EQUALS(messages[0].second, errorMessage);
    }
    TS_ASSERT_EQUALS(tris, tin->Triangles());

    // Try to add a breakline that crosses the concavity
    breakline = {4, 11};
    XmLog::Instance().GetAndClearStackStr();
    adder->AddBreakline(breakline);
    TS_ASSERT(XmLog::Instance().ErrCount() == 1);
    if (XmLog::Instance().ErrCount() > 0)
    {
      MessageStack messages = XmLog::Instance().GetAndClearStack();
      TS_ASSERT_EQUALS(messages[0].second, errorMessage);
    }
    TS_ASSERT_EQUALS(tris, tin->Triangles());

    // Try to add a breakline that crosses both inside and inner boundary
    breakline = {10, 7, 2, 8};
    XmLog::Instance().GetAndClearStackStr();
    adder->AddBreakline(breakline);
    TS_ASSERT(XmLog::Instance().ErrCount() == 1);
    if (XmLog::Instance().ErrCount() > 0)
    {
      MessageStack messages = XmLog::Instance().GetAndClearStack();
      TS_ASSERT_EQUALS(messages[0].second, errorMessage);
    }
    {
      int trisA[] = {0, 3, 2, 0, 1, 3, 1, 4, 3, 1, 5,  4, 2, 7,  6, 3, 7,  2,
                     4, 8, 7, 4, 5, 8, 6, 7, 9, 7, 10, 9, 8, 10, 7, 8, 11, 10};
      TS_ASSERT_EQUALS(VecInt(&trisA[0], &trisA[XM_COUNTOF(trisA)]), tin->Triangles());
    }

    // Try to add a breakline that crosses both inside and outer boundary
    breakline = {0, 4, 11};
    XmLog::Instance().GetAndClearStackStr();
    adder->AddBreakline(breakline);
    TS_ASSERT(XmLog::Instance().ErrCount() == 1);
    if (XmLog::Instance().ErrCount() > 0)
    {
      MessageStack messages = XmLog::Instance().GetAndClearStack();
      TS_ASSERT_EQUALS(messages[0].second, errorMessage);
    }
    {
      int trisA[] = {0, 3, 2, 0, 4, 3, 1, 4, 0, 1, 5,  4, 2, 7,  6, 3, 7,  2,
                     4, 8, 7, 4, 5, 8, 6, 7, 9, 7, 10, 9, 8, 10, 7, 8, 11, 10};
      TS_ASSERT_EQUALS(VecInt(&trisA[0], &trisA[XM_COUNTOF(trisA)]), tin->Triangles());
    }

    // Go around inner border
    breakline = {3, 4, 7, 8, 4, 3, 7};
    XmLog::Instance().GetAndClearStackStr();
    adder->AddBreakline(breakline);
    TS_ASSERT(XmLog::Instance().ErrCount() == 0);
    {
      int trisA[] = {0, 3, 2, 0, 4, 3, 1, 4, 0, 1, 5,  4, 2, 7,  6, 3, 7,  2,
                     4, 8, 7, 4, 5, 8, 6, 7, 9, 7, 10, 9, 8, 10, 7, 8, 11, 10};
      TS_ASSERT_EQUALS(VecInt(&trisA[0], &trisA[XM_COUNTOF(trisA)]), tin->Triangles());
    }

    XmLog::Instance().GetAndClearStackStr();
  }
  catch (std::exception&)
  {
    TS_FAIL("exception");
  }

} // TrBreaklineAdderUnitTests::testCrossingBoundary

  //} // namespace xms

#endif