interface updates for test cases

2026-03-31 21:49:06 -07:00
parent c3fa1de914
commit 0bcdd73882
4 changed files with 13 additions and 11 deletions
@@ -21,7 +21,7 @@ function validate(obj)
            P = min(max(obj.agents{kk}.pos, obj.obstacles{jj}.minCorner), obj.obstacles{jj}.maxCorner);
            d = obj.agents{kk}.pos - P;
            if dot(d, d) < obj.agents{kk}.collisionGeometry.radius^2
-                error("%s colliding with %s by %d", obj.agents{kk}.label, obj.obstacles{jj}.label, dot(d, d) - obj.agents{kk}.collisionGeometry.radius^2); % this will cause quadprog to fail
+                error("%s colliding with %s by %d", obj.agents{kk}.label, obj.obstacles{jj}.label, obj.agents{kk}.collisionGeometry.radius^2 - dot(d, d)); % this will cause quadprog to fail
            end
        end
    end