free_gait_rviz_plugin: Skip stance display if no foot is in ground co…

…ntact.
leggedrobotics · Aug 3, 2017 · 630436a · 630436a
1 parent 3a08ee8
commit 630436a
Showing 1 changed file with 1 addition and 0 deletions.
diff --git a/free_gait_rviz_plugin/src/FreeGaitPreviewVisual.cpp b/free_gait_rviz_plugin/src/FreeGaitPreviewVisual.cpp
@@ -200,6 +200,7 @@ void FreeGaitPreviewVisual::showStances(const float alpha)
   stancesMarker_.clear();
 
   for (const auto& stance : stateBatchPtr_->getStances()) {
+    if (stance.second.empty()) continue;
     std_msgs::ColorRGBA color;
     getRainbowColor(stateBatchPtr_->getStartTime(), stateBatchPtr_->getEndTime(), stance.first, color);
     color.a = alpha;