i/rtabmap
1
0
Fork 0
mirror of https://github.com/introlab/rtabmap.git synced 2026-09-02 09:30:25 +08:00
Code Issues Packages Projects Releases Wiki Activity

OdometryOKVIS: added warning if config file doesn't exist, also replace ~ by home directory for convenience

Browse Source
This commit is contained in:
matlabbe
2019-03-20 13:10:14 -04:00
parent b2fe138dbf
commit 24a4d91ee8
1 changed files with 8 additions and 5 deletions
Download Patch File Download Diff File Expand all files Collapse all files

13
corelib/src/odometry/OdometryOkvis.cpp
View File

@@ -32,6 +32,8 @@ SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
#include "rtabmap/utilite/UTimer.h"
#include "rtabmap/utilite/UStl.h"
#include "rtabmap/utilite/UThread.h"
#include "rtabmap/utilite/UFile.h"
#include "rtabmap/utilite/UDirectory.h"
#include <opencv2/imgproc/types_c.h>
#ifdef RTABMAP_OKVIS
@@ -140,9 +142,10 @@ OdometryOkvis::OdometryOkvis(const ParametersMap & parameters) :
{
#ifdef RTABMAP_OKVIS
Parameters::parse(parameters, Parameters::kOdomOKVISConfigPath(), configFilename_);
if(configFilename_.empty())
configFilename_ = uReplaceChar(configFilename_, '~', UDirectory::homeDir());
if(configFilename_.empty() || !UFile::exists(configFilename_))
{
UERROR("OKVIS config file is empty (%s)!", Parameters::kOdomOKVISConfigPath().c_str());
UERROR("OKVIS config file is empty or doesn't exist (%s)!", Parameters::kOdomOKVISConfigPath().c_str());
}
#endif
}
@@ -283,14 +286,14 @@ Transform OdometryOkvis::computeTransform(
}
okvis::VioParameters parameters;
if(configFilename_.empty())
if(configFilename_.empty() || !UFile::exists(configFilename_))
{
UERROR("OKVIS config file is empty (%s)!", Parameters::kOdomOKVISConfigPath().c_str());
UERROR("OKVIS config file is empty or doesn't exist (%s)!", Parameters::kOdomOKVISConfigPath().c_str());
return t;
}
else
{
okvis::VioParametersReader vio_parameters_reader(configFilename_);
okvis::VioParametersReader vio_parameters_reader(uReplaceChar(configFilename_, '~', UDirectory::homeDir()));
vio_parameters_reader.getParameters(parameters);
if(parameters.nCameraSystem.numCameras() > 0)
{