mirror of
https://github.com/introlab/rtabmap.git
synced 2026-09-02 09:30:25 +08:00
Rtabmap: updated logic of small displacement updates (RGBD/LinearUpdate=0 means always update)
This commit is contained in:
@@ -1137,11 +1137,9 @@ bool Rtabmap::process(
|
|||||||
{
|
{
|
||||||
float x,y,z, roll,pitch,yaw;
|
float x,y,z, roll,pitch,yaw;
|
||||||
links.begin()->second.transform().getTranslationAndEulerAngles(x,y,z, roll,pitch,yaw);
|
links.begin()->second.transform().getTranslationAndEulerAngles(x,y,z, roll,pitch,yaw);
|
||||||
bool isMoving = (_rgbdLinearUpdate>0.0f && (
|
bool isMoving = fabs(x) > _rgbdLinearUpdate ||
|
||||||
fabs(x) > _rgbdLinearUpdate ||
|
fabs(y) > _rgbdLinearUpdate ||
|
||||||
fabs(y) > _rgbdLinearUpdate ||
|
fabs(z) > _rgbdLinearUpdate ||
|
||||||
fabs(z) > _rgbdLinearUpdate))
|
|
||||||
||
|
|
||||||
(_rgbdAngularUpdate>0.0f && (
|
(_rgbdAngularUpdate>0.0f && (
|
||||||
fabs(roll) > _rgbdAngularUpdate ||
|
fabs(roll) > _rgbdAngularUpdate ||
|
||||||
fabs(pitch) > _rgbdAngularUpdate ||
|
fabs(pitch) > _rgbdAngularUpdate ||
|
||||||
|
|||||||
Reference in New Issue
Block a user