az_h_2a.m

来自「基于RBMCDA (Rao-Blackwellized Monte Carlo 」· M 代码 · 共 10 行

%AZ_H Azimuth measurement function for EKF.with 2d attributes
%
%  \V{x} = [x y vx vy a1 a2]^T
%
%  h = atan((y-sy) / (x-sx))
%  a = [a1 a2]^T
%  Y = [h;a]
%

% Copyright (C) 2003 Simo S鋜kk