mirror of
https://github.com/introlab/rtabmap.git
synced 2026-09-02 17:40:23 +08:00
This commit is contained in:
@@ -26,6 +26,8 @@
|
||||
|
||||
#include "edge_se3_xyzprior.h"
|
||||
|
||||
namespace rtabmap {
|
||||
|
||||
EdgeSE3XYZPrior::EdgeSE3XYZPrior() : BaseUnaryEdge<3, Eigen::Vector3d, g2o::VertexSE3>()
|
||||
{
|
||||
information().setIdentity();
|
||||
@@ -105,3 +107,5 @@ void EdgeSE3XYZPrior::initialEstimate(const g2o::OptimizableGraph::VertexSet& /*
|
||||
}
|
||||
v->setEstimate(newEstimate);
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
@@ -24,13 +24,15 @@
|
||||
// NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
|
||||
// SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||||
|
||||
#ifndef G2O_EDGE_SE3_PRIOR_XYZ_H
|
||||
#define G2O_EDGE_SE3_PRIOR_XYZ_H
|
||||
#ifndef RTAB_G2O_EDGE_SE3_PRIOR_XYZ_H
|
||||
#define RTAB_G2O_EDGE_SE3_PRIOR_XYZ_H
|
||||
|
||||
#include "g2o/types/slam3d/vertex_se3.h"
|
||||
#include "g2o/core/base_unary_edge.h"
|
||||
#include "g2o/types/slam3d/parameter_se3_offset.h"
|
||||
|
||||
namespace rtabmap {
|
||||
|
||||
/**
|
||||
* \brief Prior for a 3D pose with constraints only in xyz direction
|
||||
*/
|
||||
@@ -75,4 +77,6 @@ protected:
|
||||
g2o::CacheSE3Offset* _cache;
|
||||
};
|
||||
|
||||
}
|
||||
|
||||
#endif
|
||||
|
||||
Reference in New Issue
Block a user