聲源定位和GPS模擬實驗編程

1、1、 聲源定位：#include #include using namespace std;#define c 2982#define pai 3.1415926535int main()double x0,x1,x2,y0,y1,y2,t0,t1,t2,t3,A,B,D,angle1,angle2,dt1,dt2,r; x0=0,x1=0,x2=0.3;y0=0,y1=0.45,y2=0.45;int i = 8;while(i-)cout 請輸入第 8-i 組時間數(shù)據(jù) t0 t1 t2 t3;t0 = t0 / 1000000;t1 = t1 / 1000000;t2 = t2 / 100

2、0000;dt1 = t0 - t2;dt2 = t1 - t2;A = x2*(pow(x1,2)+pow(y1,2)-pow(c*dt1,2) - x1*(pow(x2,2)+pow(y2,2)- pow(c*dt2,2);B = y2*(pow(x1,2)+pow(y1,2)-pow(c*dt1,2) - y1*(pow(x2,2)+pow(y2,2)- pow(c*dt2,2);D = c*dt1*(pow(x2,2)+pow(y2,2)-pow(c*dt2,2) - c*dt2*(pow(x1,2)+pow(y1,2)-pow(c*dt1,2);angle2 = atan(B/A);

3、if(acos(D/sqrt(pow(A,2)+pow(B,2)+angle2 pai/2) angle1 = acos(D/sqrt(pow(A,2)+pow(B,2)+angle2;elseangle1 = angle2 - acos(D/sqrt(pow(A,2)+pow(B,2);r = (pow(x1,2)+pow(y1,2)- pow(c*dt1,2)/(2*(x1*cos(angle1)+y1*sin(angle1)+c*dt1);cout 聲源坐標(biāo)為：( r*cos(angle1)*1000mm , r*sin(angle1)*1000mm )endl; / end while

4、;-1-return 0; / end main;2、 GPS 模擬 #include #include #include using namespace std;#define c 2982#define min 0.0000000001 void GPS(double x10 , double y10 , double t10 , double x1 , double y1 , int num)double a1,a2,a3,a4,b1,b2,mult,D=0,E=0;int i;while(1)a1 = a2 = a3 = a4 = b1 = b2 = 0;for(i = 0; i 10

5、; i +)a1 = a1-(3*pow(xi-x1),2)+pow(yi/1000-y1),2)- pow(c*ti/1000000,2);a2 = a2+2*(xi/1000-x1)*(y1-yi/1000);a3 = a2;a4 = a4-(3*pow(yi-y1),2)+pow(xi/1000-x1),2)- pow(c*ti/1000000,2);b1 = b1+(pow(xi/1000-x1),2)+pow(yi/1000-y1),2)- pow(c*ti/1000000,2)*(x1-xi/1000);b2 = b2+(pow(xi/1000-x1),2)+pow(yi/1000

6、-y1),2)- pow(c*ti/1000000,2)*(y1-yi/1000); /end for;mult = a3/a1;a4 -= a2*mult;b2 -= b1*mult;E= b2/a4;D = (b1-a2*E)/a1;x1 += D;y1 += E;if(pow(D,2)+pow(E,2) min)-2- break; / end while;x1 = x1*1000;y1 = y1*1000;cout 點 P num 定位于 : X = fixed setprecision(8) x1;cout (mm) , Y = fixed setprecision(8) y1 (mm)endl; / end GPS;int main()int yy;double t110 , t210 , t310 , x10 , y10;cout 請輸入時間數(shù)據(jù) (us) 與坐標(biāo)數(shù)據(jù) (mm): endl;int i;for(i = 0; i = 9; i +)cout 第 i+1 組 : t1i t2i t3i xi yi; /