results plot1 WIP

2026-03-15 13:42:35 -07:00
parent ca891a809f
commit 2a0e2e500f
19 changed files with 437 additions and 35 deletions
--- a/@agent/initialize.m
+++ b/@agent/initialize.m
@@ -15,6 +15,7 @@ function obj = initialize(obj, pos, collisionGeometry, sensorModel, comRange, ma
    end

    obj.pos = pos;
+    obj.lastPos = pos;
    obj.vel = zeros(1, 3);
    obj.lastVel = zeros(1, 3);
    obj.collisionGeometry = collisionGeometry;