test_graph.cpp

Go to the documentation of this file.

#include <iostream>
#include <string>

#include <opencv2/core/core.hpp>
#include <opencv2/highgui/highgui.hpp>

#include <bwi_mapper/topological_mapper.h>

int main(int argc, char** argv) {

  if (argc != 2) {
    std::cerr << "USAGE: " << argv[0] << " <yaml-map-file>" << std::endl;
    return -1;
  }

  bwi_mapper::TopologicalMapper mapper(argv[1]);
  cv::Mat image;
  mapper.computeTopologicalGraph(0.3, 0.5, 3.0);
  
  mapper.drawOutput(image);
  mapper.saveOutput();

  cv::namedWindow("Display window", CV_WINDOW_AUTOSIZE);
  cv::imshow("Display window", image);                

  cv::waitKey(0); // Wait for a keystroke in the window
  return 0;
}