diff --git a/rviz_default_plugins/src/rviz_default_plugins/displays/marker/markers/points_marker.cpp b/rviz_default_plugins/src/rviz_default_plugins/displays/marker/markers/points_marker.cpp index b5238cde0..6221413a7 100644 --- a/rviz_default_plugins/src/rviz_default_plugins/displays/marker/markers/points_marker.cpp +++ b/rviz_default_plugins/src/rviz_default_plugins/displays/marker/markers/points_marker.cpp @@ -88,9 +88,9 @@ void PointsMarker::onNewMessage( setPosition(pose); setOrientation(orientation); - setRenderModeAndDimensions(new_message, scale); + points_->clearAndRemoveAllPoints(); - points_->clear(); + setRenderModeAndDimensions(new_message, scale); if (new_message->points.empty()) { return;