i/rtabmap_ros
1
0
Fork 0
mirror of https://github.com/introlab/rtabmap_ros.git synced 2026-10-04 00:37:46 +08:00
Code Issues Packages Projects Releases Wiki Activity

Fixed #149

Browse Source
This commit is contained in:
matlabbe
2016-11-30 14:25:01 -05:00
parent 4d585cbb11
commit d879491a58
4 changed files with 17 additions and 17 deletions
Download Patch File Download Diff File Expand all files Collapse all files
cmake_modules/FindG2O.cmake
+9 -7
View File
@@ -18,8 +18,7 @@ FIND_PATH(G2O_INCLUDE_DIR g2o/core/base_vertex.h
PATHS "C:\\Program Files\\g2o\\include")
# Macro to unify finding both the debug and release versions of the
# libraries; this is adapted from the OpenSceneGraph FIND_LIBRARY
# macro.
# libraries; this is adapted from the rtabmap config
MACRO(FIND_G2O_LIBRARY MYLIBRARY MYLIBRARYNAME)
@@ -31,11 +30,14 @@ MACRO(FIND_G2O_LIBRARY MYLIBRARY MYLIBRARYNAME)
NAMES "g2o_${MYLIBRARYNAME}"
PATHS "C:\\Program Files\\g2o\\lib")
IF(NOT ${MYLIBRARY}_DEBUG)
IF(MYLIBRARY)
SET(${MYLIBRARY}_DEBUG ${MYLIBRARY})
ENDIF(MYLIBRARY)
ENDIF( NOT ${MYLIBRARY}_DEBUG)
IF(${MYLIBRARY}_DEBUG AND ${MYLIBRARY})
SET(${MYLIBRARY}
debug ${${MYLIBRARY}_DEBUG}
optimized ${${MYLIBRARY}}
)
ELSEIF(${MYLIBRARY}_DEBUG)
SET(${MYLIBRARY} ${${MYLIBRARY}_DEBUG})
ENDIF()
ENDMACRO(FIND_G2O_LIBRARY LIBRARY LIBRARYNAME)
corelib/src/OptimizerG2O.cpp
-4
View File
@@ -523,10 +523,6 @@ std::map<int, Transform> OptimizerG2O::optimize(
}
}
}
optimizer.clear();
g2o::Factory::destroy();
g2o::OptimizationAlgorithmFactory::destroy();
g2o::HyperGraphActionLibrary::destroy();
}
else if(poses.size() == 1 || iterations() <= 0)
{
corelib/src/vertigo/g2o/edge_se2Switchable.cpp
+4 -3
View File
@@ -19,9 +19,10 @@ using namespace Eigen;
EdgeSE2Switchable::EdgeSE2Switchable() : g2o::BaseMultiEdge<3, g2o::SE2>()
{
resize(3);
_jacobianOplus[0].resize(3,3);
_jacobianOplus[1].resize(3,3);
_jacobianOplus[2].resize(3,1);
_jacobianOplus.clear();
_jacobianOplus.push_back(JacobianType(0, 3, 3));
_jacobianOplus.push_back(JacobianType(0, 3, 3));
_jacobianOplus.push_back(JacobianType(0, 3, 1));
}
// ================================================
corelib/src/vertigo/g2o/edge_se3Switchable.cpp
+4 -3
View File
@@ -22,9 +22,10 @@ using namespace Eigen;
EdgeSE3Switchable::EdgeSE3Switchable() : g2o::BaseMultiEdge<6, Eigen::Isometry3d>()
{
resize(3);
_jacobianOplus[0].resize(6,6);
_jacobianOplus[1].resize(6,6);
_jacobianOplus[2].resize(6,1);
_jacobianOplus.clear();
_jacobianOplus.push_back(JacobianType(0, 6, 6));
_jacobianOplus.push_back(JacobianType(0, 6, 6));
_jacobianOplus.push_back(JacobianType(0, 6, 1));
}
// ================================================