fixed cone plotting all the way to ground

This commit is contained in:
2026-01-11 18:43:44 -08:00
parent 40df9059e7
commit 7ba21fbaa7
11 changed files with 33 additions and 12 deletions

View File

@@ -67,7 +67,7 @@ function obj = run(obj, domain, partitioning, timestepIndex, index, agents)
% Compute scaling factor
targetRate = 0.2 - 0.0008 * timestepIndex; % slow down as you get closer
rateFactor = targetRate / norm(gradC);
rateFactor = targetRate / norm(gradC);
% Compute unconstrained next position
pNext = obj.pos + rateFactor * gradC;