i/rtabmap
1
0
Fork 0
mirror of https://github.com/introlab/rtabmap.git synced 2026-09-02 01:20:25 +08:00
Code Issues Packages Projects Releases Wiki Activity

Added "Cancel goal" action

Browse Source
This commit is contained in:
matlabbe
2015-06-21 20:16:56 -04:00
parent a5efee20bc
commit 87063cf357
6 changed files with 27 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files

8
corelib/src/RtabmapThread.cpp
View File

@@ -286,6 +286,9 @@ void RtabmapThread::mainLoop()
}
this->post(new RtabmapGlobalPathEvent(id, _rtabmap->getPath()));
break;
case kStateCancellingGoal:
_rtabmap->clearPath();
break;
default:
UFATAL("Invalid state !?!?");
break;
@@ -492,6 +495,11 @@ void RtabmapThread::handleEvent(UEvent* event)
param.insert(ParametersPair("goal_id", uNumber2Str(rtabmapEvent->getInt())));
pushNewState(kStateSettingGoal, param);
}
else if(cmd == RtabmapEventCmd::kCmdCancelGoal)
{
ULOGGER_DEBUG("CMD_CANCEL_GOAL");
pushNewState(kStateCancellingGoal);
}
else
{
UWARN("Cmd %d unknown!", cmd);