diff --git a/source/RobotAPI/components/DebugDrawer/DebugDrawerComponent.cpp b/source/RobotAPI/components/DebugDrawer/DebugDrawerComponent.cpp index d783b0f9de50238b220fb3f5f9662da8bda9d306..7601fb87be538abe4f0318e9d8012bc0839331cf 100644 --- a/source/RobotAPI/components/DebugDrawer/DebugDrawerComponent.cpp +++ b/source/RobotAPI/components/DebugDrawer/DebugDrawerComponent.cpp @@ -155,7 +155,7 @@ namespace armarx { ScopedRecursiveLockPtr l = getScopedVisuLock(); - for (auto & e : selectedElements) + for (auto& e : selectedElements) { coinVisu->select(coinVisu->getByName((SELECTION_NAME_PREFIX + e).c_str())); } @@ -170,16 +170,16 @@ namespace armarx DebugDrawerSelectionList selectedElements; - ARMARX_INFO << "Number of selected elements: " << coinVisu->getNumSelected(); for (int i = 0; i < coinVisu->getNumSelected(); i++) { SoPath* path = coinVisu->getPath(i); std::string name = path->getTail()->getName().getString(); - name = name.substr(strlen(SELECTION_NAME_PREFIX)); - - ARMARX_INFO << "Selection: " << name; - selectedElements.push_back(name); + if (name.length() > 0 && name.find(SELECTION_NAME_PREFIX) != 0) + { + name = name.substr(strlen(SELECTION_NAME_PREFIX)); + selectedElements.push_back(name); + } } return selectedElements; @@ -1508,7 +1508,7 @@ namespace armarx d.layerName = layerName; d.name = robotName; - for (auto & it : configuration) + for (auto& it : configuration) { d.configuration[it.first] = it.second; } @@ -1555,7 +1555,7 @@ namespace armarx void DebugDrawerComponent::clearAll(const Ice::Current&) { - for (auto & i : layers) + for (auto& i : layers) { clearLayer(i.first); } @@ -1589,57 +1589,57 @@ namespace armarx auto& layer = layers.at(layerName); - for (const auto & i : layer.addedCoordVisualizations) + for (const auto& i : layer.addedCoordVisualizations) { removePoseVisu(layerName, i.first); } - for (const auto & i : layer.addedLineVisualizations) + for (const auto& i : layer.addedLineVisualizations) { removeLineVisu(layerName, i.first); } - for (const auto & i : layer.addedBoxVisualizations) + for (const auto& i : layer.addedBoxVisualizations) { removeBoxVisu(layerName, i.first); } - for (const auto & i : layer.addedTextVisualizations) + for (const auto& i : layer.addedTextVisualizations) { removeTextVisu(layerName, i.first); } - for (const auto & i : layer.addedSphereVisualizations) + for (const auto& i : layer.addedSphereVisualizations) { removeSphereVisu(layerName, i.first); } - for (const auto & i : layer.addedCylinderVisualizations) + for (const auto& i : layer.addedCylinderVisualizations) { removeCylinderVisu(layerName, i.first); } - for (const auto & i : layer.addedPointCloudVisualizations) + for (const auto& i : layer.addedPointCloudVisualizations) { removePointCloudVisu(layerName, i.first); } - for (const auto & i : layer.addedPolygonVisualizations) + for (const auto& i : layer.addedPolygonVisualizations) { removePolygonVisu(layerName, i.first); } - for (const auto & i : layer.addedArrowVisualizations) + for (const auto& i : layer.addedArrowVisualizations) { removeArrowVisu(layerName, i.first); } - for (const auto & i : layer.addedRobotVisualizations) + for (const auto& i : layer.addedRobotVisualizations) { removeRobotVisu(layerName, i.first); } - for (const auto & i : layer.addedCustomVisualizations) + for (const auto& i : layer.addedCustomVisualizations) { removeCustomVisu(layerName, i.first); } @@ -2016,7 +2016,7 @@ namespace armarx ScopedRecursiveLockPtr l = getScopedVisuLock(); StringSequence seq {}; - for (const auto & layer : layers) + for (const auto& layer : layers) { seq.push_back(layer.first); } @@ -2029,7 +2029,7 @@ namespace armarx ::armarx::LayerInformationSequence seq {}; ScopedRecursiveLockPtr l = getScopedVisuLock(); - for (const auto & layer : layers) + for (const auto& layer : layers) { int count = layer.second.addedCoordVisualizations.size() + layer.second.addedLineVisualizations.size() +