dtumdl.m

自己编写的鲁棒滤波算法的应用

function [MM] = DtuMdl(Vt,Km,Mrnd)
%*********************************************************
%****************** 里程计模型 ***************************
%*********************************************************
[m,n] = size(Vt);
MM = sqrt( Vt(1,:).^2+Vt(2,:).^2+Vt(3,:).^2 ); %  速度矢量
MM = MM*Km + Mrnd*randn(1,n);                  %里程计模型
%*********************************************************