def normaliseAngle(value):
angle = np.fmod(value, 2 * np.pi);
if (angle <= -np.pi):
angle += np.pi * 2;
if (angle > np.pi):
angle -= 2 * np.pi;
return angle;
微信
公众号
扫码关注公众号