reorganized code into separate files

@sensingObjective/initialize.m

@@ -0,0 +1,34 @@
+function obj = initialize(obj, objectiveFunction, footprint, groundAlt, discretizationStep)
+    arguments (Input)
+        obj (1,1) {mustBeA(obj, 'sensingObjective')};
+        objectiveFunction (1, 1) {mustBeA(objectiveFunction, 'function_handle')};
+        footprint (:, 2) double;
+        groundAlt (1, 1) double = 0;
+        discretizationStep (1, 1) double = 1;
+    end
+    arguments (Output)
+        obj (1,1) {mustBeA(obj, 'sensingObjective')};
+    end
+
+    obj.groundAlt = groundAlt;
+
+    % Extract footprint limits
+    xMin = min(footprint(:, 1));
+    xMax = max(footprint(:, 1));
+    yMin = min(footprint(:, 2));
+    yMax = max(footprint(:, 2));
+
+    xGrid = unique([xMin:discretizationStep:xMax, xMax]);
+    yGrid = unique([yMin:discretizationStep:yMax, yMax]);
+    
+    % Store grid points for plotting later
+    [obj.X, obj.Y] = meshgrid(xGrid, yGrid);
+
+    % Evaluate function over grid points
+    obj.objectiveFunction = objectiveFunction;
+    obj.values = reshape(obj.objectiveFunction(obj.X, obj.Y), size(obj.X));
+
+    % store ground position
+    idx = obj.values == max(obj.values, [], "all");
+    obj.groundPos = [obj.X(idx), obj.Y(idx)];
+end