Function mono_localization

example/run_camera_localization.cc:52–155

#endif

void mono_localization(const std::shared_ptr<PLPSLAM::config> &cfg,
                       const std::string &vocab_file_path, const unsigned int cam_num, const std::string &mask_img_path,
                       const float scale, const std::string &map_db_path, const bool mapping)
{
    // load the mask image
    const cv::Mat mask = mask_img_path.empty() ? cv::Mat{} : cv::imread(mask_img_path, cv::IMREAD_GRAYSCALE);

    // build a SLAM system
    PLPSLAM::system SLAM(cfg, vocab_file_path);
    // load the prebuilt map
    SLAM.load_map_database(map_db_path);
    // startup the SLAM process (it does not need initialization of a map)
    SLAM.startup(false);
    // select to activate the mapping module or not
    if (mapping)
    {
        SLAM.enable_mapping_module();
    }
    else
    {
        SLAM.disable_mapping_module();
    }

    // create a viewer object
    // and pass the frame_publisher and the map_publisher
#ifdef USE_PANGOLIN_VIEWER
    pangolin_viewer::viewer viewer(cfg, &SLAM, SLAM.get_frame_publisher(), SLAM.get_map_publisher());
#elif USE_SOCKET_PUBLISHER
    socket_publisher::publisher publisher(cfg, &SLAM, SLAM.get_frame_publisher(), SLAM.get_map_publisher());
#endif

    auto video = cv::VideoCapture(cam_num);
    if (!video.isOpened())
    {
        spdlog::critical("cannot open a camera {}", cam_num);
        SLAM.shutdown();
        return;
    }

    cv::Mat frame;
    double timestamp = 0.0;
    std::vector<double> track_times;

    unsigned int num_frame = 0;

    bool is_not_end = true;
    // run the SLAM in another thread
    std::thread thread([&]()
                       {
                           while (is_not_end)
                           {
                               // check if the termination of SLAM system is requested or not
                               if (SLAM.terminate_is_requested())
                               {
                                   break;
                               }

                               is_not_end = video.read(frame);