mirror of
https://github.com/autolaborcenter/rviz_navi_multi_goals_pub_plugin.git
synced 2026-01-12 03:15:02 +08:00
commit
This commit is contained in:
@@ -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;
|
||||
|
||||
Reference in New Issue
Block a user