obstacle avoidance

2025-12-23 14:57:13 -08:00
parent 4fa942564a
commit 8315b6c511
6 changed files with 53 additions and 9 deletions
--- a/geometries/@rectangularPrism/rectangularPrism.m
+++ b/geometries/@rectangularPrism/rectangularPrism.m
@@ -36,6 +36,7 @@ classdef rectangularPrism
        [obj   ] = initializeRandom(obj, tag, label, minDimension, maxDimension, domain);
        [r     ] = random(obj);
        [c     ] = contains(obj, pos);
+        [cPos  ] = closestToPoint(obj, pos);
        [d     ] = distance(obj, pos);
        [g     ] = distanceGradient(obj, pos);
        [c     ] = containsLine(obj, pos1, pos2);