程序代写代做代考 function theta = normalize_theta(theta)

function theta = normalize_theta(theta)

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