Обновите мультиобъектное средство отслеживания с новыми обнаружениями
confirmedTracks = updateTracks(tracker,detections,time)multiObjectTracker Система object™, tracker. Обновления основаны на заданном списке detections, и все дорожки обновляются к заданному time. Каждый элемент в возвращенном confirmedTracks массив структур соответствует одноколейному пути.
[ также возвращает массив структур, содержащий детали о предварительных дорожках.confirmedTracks,tentativeTracks] = updateTracks(tracker,detections,time)
[ также возвращает массив структур, содержащий детали обо всех подтвержденных и предварительных дорожках, confirmedTracks,tentativeTracks,allTracks] = updateTracks(tracker,detections,time)allTracks. Дорожки возвращены в порядке, согласно которому средство отслеживания внутренне обеспечивает их. Можно использовать этот выход, чтобы помочь вам вычислить матрицу стоимости, дополнительный входной параметр.
[___] = updateTracks( задает матрицу стоимости, возвращая любой из выходных параметров от предыдущих синтаксисов.tracker,detections,time,costMatrix)
Чтобы задать матрицу стоимости, установите HasCostMatrixInput свойство tracker к true.
Сгенерируйте обнаружения с помощью автомобильного радара по ходу движения, смонтированного на автомобиле, оборудованном датчиком. Примите, что существует три цели:
Транспортное средство 1 находится в центральном маршруте, непосредственно перед автомобилем, оборудованным датчиком, и управляющий на той же скорости.
Транспортное средство 2 находится в левом маршруте и управлении быстрее, чем автомобиль, оборудованный датчиком на 12 километров в час.
Транспортное средство 3 находится в правильном маршруте и управлении медленнее, чем автомобиль, оборудованный датчиком на 5 километров в час.
Все положения, скорости и измерения относительно автомобиля, оборудованного датчиком. Запустите симуляцию для десяти шагов.
dt = 0.1; pos1 = [150 0 0]; pos2 = [160 10 0]; pos3 = [130 -10 0]; vel1 = [0 0 0]; vel2 = [12*1000/3600 0 0]; vel3 = [-5*1000/3600 0 0]; car1 = struct('ActorID',1,'Position',pos1,'Velocity',vel1); car2 = struct('ActorID',2,'Position',pos2,'Velocity',vel2); car3 = struct('ActorID',3,'Position',pos3,'Velocity',vel3);
Создайте автомобильный радарный датчик, который возмещен от автомобиля, оборудованного датчиком. По умолчанию местоположение датчика в (3.4,0) метры от центра транспортного средства и 0,2 метра над землей плоскость. Выключите расчет уровня области значений так, чтобы радарный датчик измерил положение только.
radar = radarDetectionGenerator('DetectionCoordinates','Sensor Cartesian', ... 'MaxRange',200,'RangeResolution',10,'AzimuthResolution',10, ... 'FieldOfView',[40 15],'UpdateInterval',dt,'HasRangeRate',false); tracker = multiObjectTracker('FilterInitializationFcn',@initcvkf, ... 'ConfirmationParameters',[3 4],'NumCoastingUpdates',6);
Сгенерируйте обнаружения с радаром от неавтомобилей, оборудованных датчиком. Выходные обнаружения формируют массив ячеек и могут быть переданы непосредственно в multiObjectTracker.
simTime = 0;
nsteps = 10;
for k = 1:nsteps
dets = radar([car1 car2 car3],simTime);
[confirmedTracks,tentativeTracks,allTracks] = updateTracks(tracker,dets,simTime);Переместите автомобили один временной шаг и обновите мультиобъектное средство отслеживания.
simTime = simTime + dt;
car1.Position = car1.Position + dt*car1.Velocity;
car2.Position = car2.Position + dt*car2.Velocity;
car3.Position = car3.Position + dt*car3.Velocity;
endИспользуйте birdsEyePlot создать вид сверху обнаружений. Постройте зону охвата датчика. Извлеките положения X и Y целей путем преобразования Measurement поля массива ячеек в массив MATLAB. Отобразите обнаружения на видимом с большого расстояния графике.
BEplot = birdsEyePlot('XLim',[0 220],'YLim',[-75 75]); caPlotter = coverageAreaPlotter(BEplot,'DisplayName','Radar coverage area'); plotCoverageArea(caPlotter,radar.SensorLocation,radar.MaxRange, ... radar.Yaw,radar.FieldOfView(1)) detPlotter = detectionPlotter(BEplot,'DisplayName','Radar detections'); detPos = cellfun(@(d)d.Measurement(1:2),dets,'UniformOutput',false); detPos = cell2mat(detPos')'; if ~isempty(detPos) plotDetection(detPlotter,detPos) end
Когда вы передаете обнаружения в updateTracks, функция:
Попытки присвоить входные обнаружения существующим дорожкам, с помощью assignDetectionsToTracks функция.
Создает новые треки из неприсвоенных обнаружений.
Обновления уже присвоили дорожки и возможно подтверждают их, на основе ConfirmationParameters свойство мультиобъектного средства отслеживания.
Удаляет дорожки, которые не имеют никаких присвоенных обнаружений в последнем NumCoastingUpdates обновления.