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

1、声源定位：
#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)*1000<<"mm"<<" ,
"<<r*sin(angle1)*1000<<"mm）"<<endl;
} // end while;
return 0;
} // end main;
2、 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 = "<< fixed << setprecision(8)<< x1;
cout <<"(mm) , Y = "<< fixed << setprecision(8)<< y1 <<"(mm)"<<endl; } // end GPS;
int main()
{
int yy;
double t1[10] , t2[10] , t3[10] , x[10] , y[10];
cout << "请输入时间数据(us)与坐标数据(mm):" << endl;
int i;
for(i = 0; i <= 9; i ++)
{
cout << "第" << i+1 << "组:" << endl;
cin >> t1[i] >> t2[i] >> t3[i] >> x[i] >> y[i];
} // end for;
GPS(x,y,t1,0,0.45,1);
GPS(x,y,t2,0.3,0.45,2);
GPS(x,y,t3,0,0,3);
cin>>yy;
return 0;
} // end main;。