Значение доверия измерения
d = distance( вычисляет расстояние между местоположением обнаруженного объекта и предсказанным местоположением объектом Фильтра Калмана. Этот расчет расстояния учитывает ковариацию предсказанного состояния и шума процесса. kalmanFilter,zmatrix)distance функция может только быть вызвана после predict функция.
Используйте distance функционируйте, чтобы найти лучшие соответствия. Вычисленные значения расстояния описывают, как набор измерений совпадает с Фильтром Калмана. Можно таким образом выбрать измерение что лучшие подгонки фильтр. Эта стратегия может использоваться для обнаружений соответствующего объекта против объектных дорожек в проблеме отслеживания мультиобъекта. Этот расчет расстояния учитывает ковариацию предсказанного состояния и шума процесса.
Отследите местоположение физического объекта, перемещающегося в одно направление.
Сгенерируйте синтетические данные, которые подражают 1D местоположению физического объекта, перемещающегося в постоянную скорость.
detectedLocations = num2cell(2*randn(1,40) + (1:40));
Симулируйте недостающие обнаружения, установив некоторые элементы опустеть.
detectedLocations{1} = [];
for idx = 16: 25
detectedLocations{idx} = [];
endСоздайте фигуру, чтобы показать местоположение обнаружений и результаты использования Фильтра Калмана для отслеживания.
figure; hold on; ylabel('Location'); ylim([0,50]); xlabel('Time'); xlim([0,length(detectedLocations)]);
Создайте 1D Фильтр Калмана постоянной скорости, когда физический объект будет сначала обнаружен. Предскажите местоположение основанного на объектах на предыдущих состояниях. Если объект обнаруживается на шаге текущего времени, используйте его местоположение, чтобы откорректировать состояния.
kalman = []; for idx = 1: length(detectedLocations) location = detectedLocations{idx}; if isempty(kalman) if ~isempty(location) stateModel = [1 1;0 1]; measurementModel = [1 0]; kalman = vision.KalmanFilter(stateModel,measurementModel,'ProcessNoise',1e-4,'MeasurementNoise',4); kalman.State = [location, 0]; end else trackedLocation = predict(kalman); if ~isempty(location) plot(idx, location,'k+'); d = distance(kalman,location); title(sprintf('Distance:%f', d)); trackedLocation = correct(kalman,location); else title('Missing detection'); end pause(0.2); plot(idx,trackedLocation,'ro'); end end legend('Detected locations','Predicted/corrected locations');
Используйте Фильтр Калмана, чтобы удалить шум из случайного сигнала, поврежденного нулевым средним Гауссовым шумом.
Синтезируйте случайный сигнал, который имеет значение 1 и повреждается нулевым средним Гауссовым шумом со стандартным отклонением 0,1.
x = 1; len = 100; z = x + 0.1 * randn(1,len);
Удалите шум из сигнала при помощи Фильтра Калмана. Состояние, как ожидают, будет постоянным, и измерение совпадает с состоянием.
stateTransitionModel = 1; measurementModel = 1; obj = vision.KalmanFilter(stateTransitionModel,measurementModel,'StateCovariance',1,'ProcessNoise',1e-5,'MeasurementNoise',1e-2); z_corr = zeros(1,len); for idx = 1: len predict(obj); z_corr(idx) = correct(obj,z(idx)); end
Постройте результаты.
figure, plot(x * ones(1,len),'g-'); hold on; plot(1:len,z,'b+',1:len,z_corr,'r-'); legend('Original signal','Noisy signal','Filtered signal');
