aa.rar_声源定位_声源定位’

#include <stdio.h> #include <conio.h> #include<math.h> #define c 2.982 #define X1 0.0 #define Y1 450.0 #define X2 300.5 #define Y2 450.0 float A (float t1,float t2) { float T1,T2,Z; T1=t1*c; T2=t2*c; Z=X2*(X1*X1+Y1*Y1-T1*T1)-X1*(X2*X2+Y2*Y2-T2*T2); return Z; } float B (float t1,float t2) { float T1,T2,Z; T1=t1*c; T2=t2*c; Z=Y2*(X1*X1+Y1*Y1-T1*T1)-Y1*(X2*X2+Y2*Y2-T2*T2); return Z; } float D (float t1,float t2) { float T1,T2,Z; T1=t1*c; T2=t2*c; Z=T1*(X2*X2+Y2*Y2-T2*T2)-T2*(X1*X1+Y1*Y1-T1*T1); return Z; } float P (float t1,float t2) { float Z; Z=atan(B(t1,t2)/A(t1,t2)); return Z; } float O (float t1,float t2) { float Z,Z1; Z1=acos(D(t1,t2)/sqrt(A(t1,t2)*A(t1,t2)+B(t1,t2)*B(t1,t2))); if(Z1>0) Z=P(t1,t2)+Z1; else Z=P(t1,t2)-Z1; return Z; } float R (float t1,float t2) { float Z; float T1; T1=t1*c; Z=(X1*X1+Y1*Y1-T1*T1)/(2*(X1*cos(O(t1,t2))+Y1*sin(O(t1,t2))+T1)); return Z; } int main() { float i0=0; float i1=0; float i2=0; float t1,t2; double X,Y,o,r; printf("输入时间数据"); scanf("%f,%f,%f",&i0,&i1,&i2); t1=i1-i0; t2=i2-i0; o=O(t1,t2); r=R(t1,t2); X=r*cos(o); Y=r*sin(o); printf("\nX=%lf,Y=%lf",X,Y); system("PAUSE"); return 0; }