kdee/miSim
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

cleaned up obstacle generation

Browse Source
This commit is contained in:
Kevin D
2025-11-16 10:21:58 -08:00
parent c3a840bae2
commit 24b0411af0
6 changed files with 51 additions and 78 deletions
Download Patch File Download Diff File Expand all files Collapse all files

6
@sensingObjective/initialize.m
View File

@@ -1,15 +1,17 @@
function obj = initialize(obj, objectiveFunction, domain, discretizationStep)
function obj = initialize(obj, objectiveFunction, domain, discretizationStep, protectedRange)
arguments (Input)
obj (1,1) {mustBeA(obj, 'sensingObjective')};
objectiveFunction (1, 1) {mustBeA(objectiveFunction, 'function_handle')};
domain (1, 1) {mustBeGeometry};
discretizationStep (1, 1) double = 1;
protectedRange (1, 1) double = 1;
end
arguments (Output)
obj (1,1) {mustBeA(obj, 'sensingObjective')};
end
obj.groundAlt = domain.minCorner(3);
obj.protectedRange = protectedRange;
% Extract footprint limits
xMin = min(domain.footprint(:, 1));
@@ -30,4 +32,6 @@ function obj = initialize(obj, objectiveFunction, domain, discretizationStep)
% store ground position
idx = obj.values == max(obj.values, [], "all");
obj.groundPos = [obj.X(idx), obj.Y(idx)];
assert(domain.distance([obj.groundPos, domain.center(3)]) > protectedRange, "Domain is crowding the sensing objective")
end

6
@sensingObjective/initializeRandomMvnpdf.m
View File

@@ -1,9 +1,9 @@
function obj = initializeRandomMvnpdf(obj, domain, protectedRange, discretizationStep)
function obj = initializeRandomMvnpdf(obj, domain, discretizationStep, protectedRange)
arguments (Input)
obj (1, 1) {mustBeA(obj, 'sensingObjective')};
domain (1, 1) {mustBeGeometry};
protectedRange (1, 1) double = 1;
discretizationStep (1, 1) double = 1;
protectedRange (1, 1) double = 1;
end
arguments (Output)
obj (1, 1) {mustBeA(obj, 'sensingObjective')};
@@ -23,5 +23,5 @@ function obj = initializeRandomMvnpdf(obj, domain, protectedRange, discretizatio
objectiveFunction = @(x, y) mvnpdf([x(:), y(:)], mu, sig);
% Regular initialization
obj = obj.initialize(objectiveFunction, domain, discretizationStep);
obj = obj.initialize(objectiveFunction, domain, discretizationStep, protectedRange);
end

5
@sensingObjective/sensingObjective.m
View File

@@ -9,11 +9,12 @@ classdef sensingObjective
X = [];
Y = [];
values = [];
protectedRange = 1; % keep obstacles from crowding objective
end
methods (Access = public)
[obj] = initialize(obj, objectiveFunction, domain, discretizationStep);
[obj] = initializeRandomMvnpdf(obj, domain, protectedRange, discretizationStep);
[obj] = initialize(obj, objectiveFunction, domain, discretizationStep, protectedRange);
[obj] = initializeRandomMvnpdf(obj, domain, protectedRange, discretizationStep, protectedRange);
[f ] = plot(obj, ind, f);
end
end