localization-of-sound-source.zip_localization_sound localization

#include <stdio.h> #include <conio.h> #include <math.h> #define c 2.982; #define x1 0 #define x2 300 #define y1 450 #define y2 450 float i0; float i1; float i2; 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,Z1,Z2; T1=t1*c; T2=t2*c; Z1=y2*(x1*x1+y1*y1-T1*T1); Z2=y1*(x2*x2+y2*y2-T2*T2); Z=Z1-Z2; 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; Z=P(t1,t2)+acos(D(t1,t2)/sqrt(A(t1,t2)*A(t1,t2)+B(t1,t2)*B(t1,t2))); if((Z-P(t1,2))<0) Z=P(t1,t2)-acos(D(t1,t2)/sqrt(A(t1,t2)*A(t1,t2)+B(t1,t2)*B(t1,t2))); 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; } void main() { float t1,t2; float X,Y,o,r; while(1){ printf("Input 3 data:"); 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=%f,Y=%f\n",X,Y); getchar(); } }