refactored agent sensing and guidance

guidanceModels/gradientAscent.m

@@ -0,0 +1,14 @@
+function nextPos = gradientAscent(sensedValues, sensedPositions, pos)
+    arguments (Input)
+        sensedValues (:, 1) double;
+        sensedPositions (:, 3) double;
+        pos (1, 3) double;
+    end
+    arguments (Output)
+        nextPos(1, 3) double;
+    end
+    
+    % Select next position by maximum sensed value
+    nextPos = sensedPositions(sensedValues == max(sensedValues), :);
+    nextPos = [nextPos(1, 1:2), pos(3)]; % just in case two get selected, simply pick one
+end