mirror of
https://github.com/introlab/rtabmap_ros.git
synced 2026-10-10 11:39:49 +08:00
fixed goal events sent by DBReader
This commit is contained in:
@@ -205,19 +205,19 @@ void DBReader::mainLoop()
|
|||||||
double delay = stamp - previousStamp;
|
double delay = stamp - previousStamp;
|
||||||
UWARN("Goal %d detected, posting it! Waiting %f seconds before sending next data...",
|
UWARN("Goal %d detected, posting it! Waiting %f seconds before sending next data...",
|
||||||
goalId, delay);
|
goalId, delay);
|
||||||
this->post(new RtabmapEventCmd(RtabmapEventCmd::kCmdGoal, "", goalId));
|
this->post(new RtabmapEventCmd(RtabmapEventCmd::kCmdGoal, goalId));
|
||||||
uSleep(delay*1000);
|
uSleep(delay*1000);
|
||||||
}
|
}
|
||||||
else
|
else
|
||||||
{
|
{
|
||||||
UWARN("Goal %d detected, posting it!", goalId);
|
UWARN("Goal %d detected, posting it!", goalId);
|
||||||
this->post(new RtabmapEventCmd(RtabmapEventCmd::kCmdGoal, "", goalId));
|
this->post(new RtabmapEventCmd(RtabmapEventCmd::kCmdGoal, goalId));
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
else
|
else
|
||||||
{
|
{
|
||||||
UWARN("Goal %d detected, posting it!", goalId);
|
UWARN("Goal %d detected, posting it!", goalId);
|
||||||
this->post(new RtabmapEventCmd(RtabmapEventCmd::kCmdGoal, "", goalId));
|
this->post(new RtabmapEventCmd(RtabmapEventCmd::kCmdGoal, goalId));
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|||||||
Reference in New Issue
Block a user