graph.h

Go to the documentation of this file.

/* ----------------------------------------------------------------------------
 
 * GTSAM Copyright 2010, Georgia Tech Research Corporation,
 * Atlanta, Georgia 30332-0415
 * All Rights Reserved
 * Authors: Frank Dellaert, et al. (see THANKS for the full author list)
 
 * See LICENSE for the license information
 
 * -------------------------------------------------------------------------- */
 
#pragma once
 
#include <map>
 
#define BOOST_NO_HASH  // to pacify the warnings about depricated headers in boost.graph
 
#include <boost/graph/graph_traits.hpp>
#include <boost/graph/adjacency_list.hpp>
#include <memory>
#include <gtsam/nonlinear/Values.h>
 
namespace gtsam {
 
  // type definitions :
 
  template<class KEY>
  class SDGraph: public boost::adjacency_list<boost::vecS, boost::vecS, boost::undirectedS,
  boost::property<boost::vertex_name_t, KEY>, boost::property<
  boost::edge_weight_t, double> > {
  public:
    typedef typename boost::graph_traits<SDGraph<KEY> >::vertex_descriptor Vertex;
  };
 
  template<class KEY>
  class SGraph : public boost::adjacency_list<boost::vecS, boost::vecS, boost::directedS,
      boost::property<boost::vertex_name_t, KEY> > {
  public:
    typedef typename boost::graph_traits<SGraph<KEY> >::vertex_descriptor Vertex;
  };
 
  //typedef boost::graph_traits<SGraph>::vertex_descriptor SVertex;
 
  template<class KEY>
  class PredecessorMap: public std::map<KEY, KEY> {
  public:
    inline void insert(const KEY& key, const KEY& parent) {
      std::map<KEY, KEY>::emplace(key, parent);
    }
  };
 
  template<class KEY>
  std::list<KEY> predecessorMap2Keys(const PredecessorMap<KEY>& p_map);
 
    template<class G, class F, class KEY> SDGraph<KEY> toBoostGraph(const G& graph);
 
  template<class G, class V, class KEY>
  std::tuple<G, V, std::map<KEY,V> >  predecessorMap2Graph(const PredecessorMap<KEY>& p_map);
 
  template<class G, class Factor, class POSE, class KEY>
  std::shared_ptr<Values>
    composePoses(const G& graph, const PredecessorMap<KEY>& tree, const POSE& rootPose);
 
 
  template<class G, class KEY, class FACTOR2>
  PredecessorMap<KEY> findMinimumSpanningTree(const G& g) ;
 
  template<class G, class KEY, class FACTOR2>
  void split(const G& g, const PredecessorMap<KEY>& tree, G& Ab1, G& Ab2) ;
 
 
} // namespace gtsam
 
#include <gtsam/inference/graph-inl.h>