mirror of
https://github.com/introlab/rtabmap.git
synced 2026-09-02 01:20:25 +08:00
Removed assert when data.id = 0 (only requirement for odom is that id >=0)
This commit is contained in:
@@ -203,6 +203,8 @@ Transform Odometry::process(SensorData & data, OdometryInfo * info)
|
||||
|
||||
Transform Odometry::process(SensorData & data, const Transform & guessIn, OdometryInfo * info)
|
||||
{
|
||||
UASSERT_MSG(data.id() >= 0, uFormat("Input data should have ID greater or equal than 0 (id=%d)!", data.id()).c_str());
|
||||
|
||||
// Ground alignment
|
||||
if(_pose.isIdentity() && _alignWithGround)
|
||||
{
|
||||
|
||||
@@ -804,8 +804,6 @@ Transform OdometryF2M::computeTransform(
|
||||
UFATAL("invalid camera model!");
|
||||
}
|
||||
bundleModels_.insert(std::make_pair(lastFrame_->id(), model));
|
||||
|
||||
UASSERT_MSG(lastFrame_->id() > 0, uFormat("Input data should have ID greater than 0 when odometry bundle adjustment is enabled!").c_str());
|
||||
bundlePoses_.insert(std::make_pair(lastFrame_->id(), newFramePose));
|
||||
}
|
||||
|
||||
|
||||
Reference in New Issue
Block a user