gfs_nogui.cpp

Go to the documentation of this file.

/*****************************************************************
 *
 * This file is part of the GMAPPING project
 *
 * GMAPPING Copyright (c) 2004 Giorgio Grisetti, 
 * Cyrill Stachniss, and Wolfram Burgard
 *
 * This software is licensed under the 3-Clause BSD License
 * and is copyrighted by Giorgio Grisetti, Cyrill Stachniss, 
 * and Wolfram Burgard.
 * 
 * Further information on this license can be found at:
 * https://opensource.org/licenses/BSD-3-Clause
 * 
 * GMAPPING is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied 
 * warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR
 * PURPOSE.  
 *
 *****************************************************************/


#ifndef _WIN32
  #include <unistd.h>
#endif
#include "gmapping/gui/gsp_thread.h"

using namespace GMapping;

int  main (int argc, char ** argv){
  cerr << "GMAPPING copyright 2004 by Giorgio Grisetti, Cyrill Stachniss," << endl ;
  cerr << "and Wolfram Burgard. Published under the 3-Clause BSD License," << endl ;
  cerr << "see: https://opensource.org/licenses/BSD-3-Clause" << endl << endl;


        GridSlamProcessorThread* gsp=  new GridSlamProcessorThread;
        if (gsp->init(argc, argv)){
                cout << "GSP INIT ERROR" << endl;
                return -1;
        }
        cout <<"GSP INITIALIZED"<< endl;
        if (gsp->loadFiles()){
                cout <<"GSP READFILE ERROR"<< endl;
                return -2;
        }
        cout <<"FILES LOADED"<< endl;
        gsp->setMapUpdateTime(1000000);
        gsp->start();
        cout <<"THREAD STARTED"<< endl;
        bool done=false;
        while (!done){
                GridSlamProcessorThread::EventDeque events=gsp->getEvents();
                for (GridSlamProcessorThread::EventDeque::iterator it=events.begin(); it!=events.end(); it++){
                        cout << flush;
                        GridSlamProcessorThread::DoneEvent* doneEvent=dynamic_cast<GridSlamProcessorThread::DoneEvent*>(*it);
                        if (doneEvent){
                                done=true;
                                cout <<"DONE!"<< endl;
                                gsp->stop();
                        }
                        if (*it)
                                delete(*it);
                }
        }
}