From dcc2e0b7491b6d3af45b168c8c48df124aaf313a Mon Sep 17 00:00:00 2001
From: Ryoo <lzyxgs@qq.com>
Date: Mon, 21 Sep 2020 14:24:59 +0800
Subject: [PATCH] commit

---
 src/teleop_pad.cpp | 1 +
 1 file changed, 1 insertion(+)

diff --git a/src/teleop_pad.cpp b/src/teleop_pad.cpp
index c4d5a86..393ab82 100755
--- a/src/teleop_pad.cpp
+++ b/src/teleop_pad.cpp
@@ -195,6 +195,7 @@ namespace navi_multi_goals_pub_rviz_plugin {
 
     // start to navigate, and only command the first goal
     void MultiNaviGoalsPanel::startNavi() {
+        curGoalIdx_ = curGoalIdx_ % pose_array_.poses.size();
         if (!pose_array_.poses.empty() && curGoalIdx_ < maxNumGoal_) {
             geometry_msgs::PoseStamped goal;
             goal.header = pose_array_.header;