contrib/brl/bbas/btol/btol_vertex_algs.cxx

Go to the documentation of this file.

#include "btol_vertex_algs.h"
//:
// \file
#include <vcl_cmath.h> // for fabs()
#include <vcl_algorithm.h>
#include "btol_edge_algs.h"
#include <vtol/vtol_vertex.h>
#include <vtol/vtol_vertex_2d.h>
#include <vtol/vtol_edge_sptr.h>

//: Destructor
btol_vertex_algs::~btol_vertex_algs()
{
}

//:
//-----------------------------------------------------------------------------
// Replaces va by vb on all the edges connected to va.
// The result is that vb has the union of the sets of
// edges incident on va and vb as superiors.
//-----------------------------------------------------------------------------
bool btol_vertex_algs::merge_superiors(vtol_vertex_sptr& va,
                                       vtol_vertex_sptr& vb)
{
  if (!va||!vb)
    return false;
  vcl_vector<vtol_edge_sptr> edges; va->edges(edges);
  for (vcl_vector<vtol_edge_sptr>::iterator eit = edges.begin();
       eit != edges.end(); eit++)
    btol_edge_algs::subst_vertex_on_edge(va, vb, *eit);
  return true;
}

#if 0 // unused static function
static void vertex_erase(vcl_vector<vtol_vertex_sptr>& verts,
                         vtol_vertex_sptr& v)
{
  vcl_vector<vtol_vertex_sptr>::iterator vit =
    vcl_find(verts.begin(), verts.end(), v);
  if (vit == verts.end())
    return;
  verts.erase(vit);
  return;
}
#endif // 0

vtol_vertex_2d_sptr btol_vertex_algs::
transform(vtol_vertex_2d_sptr const& v,
          vnl_matrix_fixed<double,3,3> const& T)
{
  vnl_vector_fixed<double,3> P(v->x(), v->y(), 1.0);
  vnl_vector_fixed<double,3> p = T*P;
  if (vcl_fabs(p[2])<1e-06)
    return 0;
  else
    return new vtol_vertex_2d(p[0]/p[2], p[1]/p[2]);
}