mirror of
https://github.com/introlab/rtabmap_ros.git
synced 2026-10-04 00:37:46 +08:00
fixed sending goal commands from rtabmapviz
This commit is contained in:
@@ -37,7 +37,6 @@
|
|||||||
<param name="RGBD/LocalLoopDetectionTime" type="string" value="false"/> <!-- Local loop closure detection with locations in STM -->
|
<param name="RGBD/LocalLoopDetectionTime" type="string" value="false"/> <!-- Local loop closure detection with locations in STM -->
|
||||||
<param name="RGBD/OptimizeFromGraphEnd" type="string" value="true"/>
|
<param name="RGBD/OptimizeFromGraphEnd" type="string" value="true"/>
|
||||||
<param name="LccIcp/Type" type="string" value="2"/> <!-- 0=No ICP, 1=ICP 3D, 2=ICP 2D -->
|
<param name="LccIcp/Type" type="string" value="2"/> <!-- 0=No ICP, 1=ICP 3D, 2=ICP 2D -->
|
||||||
<param name="LccBow/MaxDepth" type="string" value="0.0"/> <!-- 3D visual words maximum depth 0=infinity -->
|
|
||||||
<param name="LccBow/InlierDistance" type="string" value="0.1"/> <!-- 3D visual words correspondence distance -->
|
<param name="LccBow/InlierDistance" type="string" value="0.1"/> <!-- 3D visual words correspondence distance -->
|
||||||
<param name="RGBD/OptimizeFromGraphEnd" type="string" value="false"/> <!-- Optimize graph from initial node so /map -> /odom transform will be generated -->
|
<param name="RGBD/OptimizeFromGraphEnd" type="string" value="false"/> <!-- Optimize graph from initial node so /map -> /odom transform will be generated -->
|
||||||
</node>
|
</node>
|
||||||
|
|||||||
+4
-3
@@ -381,10 +381,11 @@ void GuiWrapper::handleEvent(UEvent * anEvent)
|
|||||||
}
|
}
|
||||||
else if(cmd == rtabmap::RtabmapEventCmd::kCmdLabel)
|
else if(cmd == rtabmap::RtabmapEventCmd::kCmdLabel)
|
||||||
{
|
{
|
||||||
UASSERT(cmdEvent->value1().isStr() || cmdEvent->value1().isInt() || cmdEvent->value1().isUInt());
|
UASSERT(cmdEvent->value1().isStr());
|
||||||
|
UASSERT(cmdEvent->value2().isUndef() || cmdEvent->value2().isInt() || cmdEvent->value2().isUInt());
|
||||||
rtabmap_ros::SetLabel setLabelSrv;
|
rtabmap_ros::SetLabel setLabelSrv;
|
||||||
setLabelSrv.request.node_id = !cmdEvent->value1().isStr()?cmdEvent->value1().toInt():0;
|
setLabelSrv.request.node_label = cmdEvent->value1().toStr();
|
||||||
setLabelSrv.request.node_label = cmdEvent->value1().isStr()?cmdEvent->value1().toStr():"";
|
setLabelSrv.request.node_id = cmdEvent->value2().isUndef()?0:cmdEvent->value2().toInt();
|
||||||
if(!ros::service::call("set_label", setLabelSrv))
|
if(!ros::service::call("set_label", setLabelSrv))
|
||||||
{
|
{
|
||||||
ROS_ERROR("Can't call \"set_label\" service");
|
ROS_ERROR("Can't call \"set_label\" service");
|
||||||
|
|||||||
Reference in New Issue
Block a user