www.gusucode.com > matlab编程实现平台的slam模拟器源码程序 > matlab编程实现平台的slam模拟器源码程序/ekf-slam-matlab-master/tools/getPiToPi.m
% Convert input angle so that it is in the range -pi to pi. function angle = getPiToPi(angle) if angle > pi angle = angle - 2*pi; elseif angle < -pi angle = angle + 2*pi; end end