pgc1.m

来自「这是一个用于语音信号处理的工具箱」· M 代码 · 共 77 行

%pgc1.m

function [ins_x,ins_y]=pgc1(q_x,q_y, w_x,w_y, c1_x,c1_y, r1, c2_x,c2_y, r2,PF_x,PF_y,PS_x,PS_y,JAW_x,JAW_y,L6_x,L6_y,L7_x,L7_y,T_x)
%	global PF_x PF_y PS_x PS_y JAW_x JAW_y L6_x L6_y L7_x L7_y T_x
	[ins1_x,ins1_y] = cint(c1_x,c1_y, r1, q_x,q_y, w_x,w_y);
	[ins2_x,ins2_y] = cint(c2_x,c2_y, r2, q_x,q_y, w_x,w_y);
	[ins3_x,ins3_y] = intersec(q_x,q_y, w_x,w_y, PF_x,PF_y, PS_x,PS_y);
	[ins4_x,ins4_y] = intersec(q_x,q_y, w_x,w_y, PS_x,PS_y, JAW_x,JAW_y);
	[ins5_x,ins5_y] = intersec(q_x,q_y, w_x,w_y, JAW_x,JAW_y, L6_x,L6_y);
	[ins6_x,ins6_y] = intersec(q_x,q_y, w_x,w_y, L6_x,L6_y, L7_x,L7_y);

	if ((ins1_x < T_x) & (ins1_x ~= 0.000))
		ins_x=ins1_x;
		ins_y=ins1_y;
		return;
	end
	if ((ins2_x ~= 0.000) & (ins2_y >= PF_y) & (ins2_y <= q_y))
		if ((ins2_x >= PF_x & ins2_y >= ins1_y & ins1_y ~= 0.000))
			if (ins3_x >= PF_x & ins3_x <= PS_x)
				ins_x=ins3_x;
				ins_y=ins3_y;
				return;
			end
			if (ins4_x >= PS_x & ins4_x <= JAW_x)
				ins_x=ins4_x;
				ins_y=ins4_y;
				return;
			end
			if ((ins5_y >= JAW_y & ins5_y <= L6_y) | (ins5_y <= JAW_y & ins5_y >= L6_y))
				ins_x=ins5_x;
				ins_y=ins5_y;
				return;
			end
			if (ins6_x >= L6_x & ins6_x <= L7_x)
				ins_x=ins6_x;
				ins_y=ins6_y;
				return;
			end
			ins1_x = 0.000;
			ins1_y = 0.000;
			ins_x=ins1_x;
			ins_y=ins1_y;
			return;

		else
			ins_x=ins2_x;
			ins_y=ins2_y;
			return
		end
	end
	if (ins3_x >= PF_x & ins3_x <= PS_x)
			ins_x=ins3_x;
			ins_y=ins3_y;
			return;
	end
	if (ins4_x >= PS_x & ins4_x <= JAW_x)
			ins_x=ins4_x;
			ins_y=ins4_y;
			return;
	end
	if ((ins5_y >= JAW_y & ins5_y <= L6_y) | (ins5_y <= JAW_y & ins5_y >= L6_y))
			ins_x=ins5_x;
			ins_y=ins5_y;
			return;
	end
	if (ins6_x >= L6_x & ins6_x <= L7_x)
			ins_x=ins6_x;
			ins_y=ins6_y;
			return;
	end
	ins1_x = 0.000;
	ins1_y = 0.000;
	ins_x=ins1_x;
	ins_y=ins1_y;
	return;