C++ (Cpp) graph_t::addNodeの例

コード例 #1

ファイル: pose_graph_test.cpp プロジェクト: Lukx19/dynamic_slam

void prepareGraphIncrementaly(graph_t &graph)
{
  obj_t obj;
  P::Pose p;
  P::InformMatrix inform;
  graph.addNode(node_t(p, obj));
  for (size_t i = 0; i < 19; ++i) {
    graph.addNode(node_t(p, obj));
    graph.addEdge(edge_t(&graph.getNode(i), &graph.getNode(i + 1), p, inform));
  }
}