59 lines
1.9 KiB
Matlab
59 lines
1.9 KiB
Matlab
classdef agent
|
|
properties (SetAccess = private, GetAccess = public)
|
|
% Identifiers
|
|
index = NaN;
|
|
label = "";
|
|
|
|
% Sensor
|
|
sensingFunction = @(r) 0.5; % probability of detection as a function of range
|
|
|
|
% State
|
|
pos = NaN(1, 3);
|
|
vel = NaN(1, 3);
|
|
cBfromC = NaN(3); % DCM body from sim cartesian (assume fixed for now)
|
|
|
|
% Collision
|
|
collisionGeometry;
|
|
end
|
|
|
|
methods (Access = public)
|
|
function obj = initialize(obj, pos, vel, cBfromC, collisionGeometry, index, label)
|
|
arguments (Input)
|
|
obj (1, 1) {mustBeA(obj, 'agent')};
|
|
pos (1, 3) double;
|
|
vel (1, 3) double;
|
|
cBfromC (3, 3) double {mustBeDcm};
|
|
collisionGeometry (1, 1) {mustBeConstraintGeometries};
|
|
index (1, 1) double = NaN;
|
|
label (1, 1) string = "";
|
|
end
|
|
arguments (Output)
|
|
obj (1, 1) {mustBeA(obj, 'agent')};
|
|
end
|
|
|
|
obj.pos = pos;
|
|
obj.vel = vel;
|
|
obj.cBfromC = cBfromC;
|
|
obj.collisionGeometry = collisionGeometry;
|
|
obj.index = index;
|
|
obj.label = label;
|
|
end
|
|
function f = plot(obj, f)
|
|
arguments (Input)
|
|
obj (1, 1) {mustBeA(obj, 'agent')};
|
|
f (1, 1) {mustBeA(f, 'matlab.ui.Figure')} = figure;
|
|
end
|
|
arguments (Output)
|
|
f (1, 1) {mustBeA(f, 'matlab.ui.Figure')};
|
|
end
|
|
|
|
% Create axes if they don't already exist
|
|
f = firstPlotSetup(f);
|
|
|
|
% Plot points representing the agent position
|
|
hold(f.CurrentAxes, "on");
|
|
scatter3(obj.pos(1), obj.pos(2), obj.pos(3), 'filled', 'ko', 'SizeData', 50);
|
|
hold(f.CurrentAxes, "off");
|
|
end
|
|
end
|
|
end |