summaryrefslogtreecommitdiff
path: root/digital/io-hub/src/common-cc/obstacles.cc
diff options
context:
space:
mode:
Diffstat (limited to 'digital/io-hub/src/common-cc/obstacles.cc')
-rw-r--r--digital/io-hub/src/common-cc/obstacles.cc14
1 files changed, 14 insertions, 0 deletions
diff --git a/digital/io-hub/src/common-cc/obstacles.cc b/digital/io-hub/src/common-cc/obstacles.cc
index 1c02cce6..882744e8 100644
--- a/digital/io-hub/src/common-cc/obstacles.cc
+++ b/digital/io-hub/src/common-cc/obstacles.cc
@@ -143,3 +143,17 @@ Obstacles::blocking (const vect_t &robot, const vect_t &dest) const
return false;
}
+void
+Obstacles::add_obstacles (Path &path) const
+{
+ int index = 0;
+ for (int i = 0; i < obstacles_nb_; i++)
+ {
+ if (obstacles_[i].valid)
+ {
+ path.obstacle (index++, obstacles_[i].pos,
+ obstacle_radius_mm + clearance_mm + BOT_SIZE_SIDE);
+ }
+ }
+}
+