声源定位和GPS模拟实验编程.doc

声源定位： #include iostream #include cmath using namespace std; #define c 2982 #define pai 3.1415926535 int 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组时间数据 endl; cin t0 t1 t2 t3; t0 = t0 / 1000000; t1 = t1 / 1000000; t2 = t2 / 1000000; 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); if(acos(D/sqrt(pow(A,2)+pow(B,2)))+angle2 pai/2) angle1 = acos(D/sqrt(pow(A,2)+pow(B,2)))+angle2; else angle1 = 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 声源坐标为：（r*cos(angle1)*1000mm , r*sin(angle1)*1000mm）endl; } // end while; return 0; } // end main; GPS模拟 #include iostream #include cmath #include iomanip using namespace std; #define c 2982 #define min 0.0000000001 void GPS(double x[10] , double y[10] , double t[10] , 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; i ++) { a1 = a1-(3*pow((x[i]-x1),2)+pow((y[i]/1000-y1),2)-pow(c*t[i]/1000000,2)); a2 = a2+2*(x[i]/1000-x1)*(y1-y[i]/1000); a3 = a2; a4 = a4-(3*pow((y[i]-y1),2)+pow((x[i]/1000-x1),2)-pow(c*t[i]/1000000,2)); b1 = b1+(pow((x[i]/1000-x1),2)+pow((y[i]/1000-y1),2)-pow(c*t[i]/1000000,2))*(x1-x[i]/1000); b2 = b2+(pow((x[i]/1000-x1),2)+pow((y[i]/1000-y1),2)-pow(c*t[i]/1000000,2))*(y1-y[i]/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) break; } // end while; x1 = x1*1000; y1 = y1*1000; cout 点P num 定位于: X = f