diff --git a/crosbot_explore/src/nodes/explorer.cpp b/crosbot_explore/src/nodes/explorer.cpp index 9a10573ac48ffea025dd48aa5eb087c5a9f0bdc4..9d8085a7f93475e49aa88b260bea937c5d5e38ce 100644 --- a/crosbot_explore/src/nodes/explorer.cpp +++ b/crosbot_explore/src/nodes/explorer.cpp @@ -94,6 +94,10 @@ public: voronoiConstraints.expand = voronoiCfg->getParamAsDouble("expand", voronoiConstraints.expand); voronoiConstraints.orphanThreshold = voronoiCfg->getParamAsInt("orphan", voronoiConstraints.orphanThreshold); } + if (cfg != NULL) { + drive.maxVel = cfg->getParamAsDouble("maxVel", drive.maxVel); + drive.maxTurn = cfg->getParamAsDouble("maxTurn", drive.maxTurn); + } gridSub = nh.subscribe("map", 1, &ExplorerNode::callbackOccGrid, this); historySub = nh.subscribe("history", 1, &ExplorerNode::callbackHistory, this);