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

1、1、 声源定位：#include <iostream>#include <cmath>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<<"

2、;组时间数据"<< 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(

3、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;elseangle1 = angle2 - acos(D/sqrt(pow(A,2)+pow(B,2);r = (pow(x1,2)+pow(y1,2)-po

4、w(c*dt1,2)/(2*(x1*cos(angle1)+y1*sin(angle1)+c*dt1);cout << "声源坐标为：（"<<r*cos(angle1)*1000<<"mm"<<" , "<<r*sin(angle1)*1000<<"mm）"<<endl; / end while;return 0; / end main;2、 GPS模拟#include <iostream>#include <cm

5、ath>#include <iomanip>using namespace std;#define c 2982#define min 0.0000000001void 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; i +)a1 = a1-(3*pow(xi-x1)

6、,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-y1),2)-pow(c*ti/1000000,2)*(y

7、1-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)break; / end while;x1 = x1*1000;y1 = y1*1000;cout <<"点P"<< num <<"定位于: X = "<< fixed << setprecision(8)<< x1;

8、cout <<"(mm) , Y = "<< fixed << setprecision(8)<< y1 <<"(mm)"<<endl; / end GPS;int main()int yy;double t110 , t210 , t310 , x10 , y10;cout << "请输入时间数据(us)与坐标数据(mm):" << endl;int i;for(i = 0; i <= 9; i +)cout << "第" << i+1 << "组:" << endl;cin >> t1i >> t2i >> t3i &