bot_h.m

来自「有关kalman滤波及其一些变形滤波算法」· M 代码 · 共 6 行

% Azimuth measurement function for EKF/UKF.
%
%  h = atan((y-sy) / (x-sx))
%

% Copyright (C) 2003 Simo S鋜kk