anglewrap.m

来自「Extended Kalman Filter for robot localiz」· M 代码 · 共 8 行

function a = AngleWrap(a)

if(a>pi)
    a=a-2*pi;
elseif(a<-pi)
    a = a+2*pi;
end;