angle.m

这是一个用于语音信号处理的工具箱

% angle.m

function ang=angle(p_x,p_y,pr_x,pr_y)
	
	xd = p_x - pr_x;
	yd = p_y - pr_y;

	if (xd > 0 & yd > 0)
		ang = atan(yd/xd);
	end
	if (xd == 0 & yd > 0)
		ang = 0.5*pi;
	end
	if (xd < 0 & yd >= 0)
		ang = pi + atan(yd/xd);
	end
	if (xd < 0 & yd < 0)
		ang = pi + atan(yd/xd);
	end
	if (xd == 0 & yd < 0)
		ang = 1.5*pi;
	end
	if (xd > 0 & yd <= 0)
		ang = 2*pi + atan(yd/xd);
	end