ROS 角度标准 逆时针为正 角度在0-180 if(theta >= M_PI) theta = theta -2 * M_PI; if(theta <= M_PI) theta = theta + 2 * M_PI;