nic/drawing-robot-ros2
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Fix bad vector indexing

Browse Source
This commit is contained in:
Nicolas Hiillos
2023-02-09 10:55:55 +02:00
parent 5c1e41cd1c
commit b5bd9beca8
1 changed files with 2 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files

4
src/axidraw_controller/src/cpp/axidraw_controller.cpp
View File

@@ -158,10 +158,9 @@ class AxidrawController : public RobotController
else else
{ {
this->pendown_pub->publish(std_msgs::msg::Empty()); this->pendown_pub->publish(std_msgs::msg::Empty());
while (i + 1 < points.size() && points[i + 1].z <= 0) while (i + count + 1 < points.size() && points[i + count + 1].z <= 0)
{ {
count++; count++;
i++;
} }
} }
@@ -184,6 +183,7 @@ class AxidrawController : public RobotController
RCLCPP_INFO(this->get_logger(), log.c_str()); RCLCPP_INFO(this->get_logger(), log.c_str());
this->path_pub->publish(msg); this->path_pub->publish(msg);
} }
i += count;
// Update status // Update status
feedback->status = std::to_string(i+1) + "/" + std::to_string(points.size()) + " complete"; feedback->status = std::to_string(i+1) + "/" + std::to_string(points.size()) + " complete";