GPS模拟C语言

GPS模拟# include # include # include using namespace std;ifstream fin ("1.txt");//ofstreamfout ("data_out.txt");// 1 2 3 4double x[5] = {-1, 0, 300, 0, 300};double y[5] = {-1, 450, 450, 0, 0};double t[5];double A, B, D,c = 2982000, p, r;double pi = 3.141592653;double xx, yy;//三角形算法void cal (int sign, double t1, double t2, double x1, double y1, double x2, double y2, double px, double py){double tt1 = c * t1, tt2 = c * t2;double q, ac;A = x2 * (x1*x1 + y1*y1 - tt1*tt1) - x1 * (x2*x2 + y2*y2 - tt2*tt2);B = y2 * (x1*x1 + y1*y1 - tt1*tt1) - y1 * (x2*x2 + y2*y2 - tt2*tt2);D = tt1 * (x2*x2 + y2*y2 - tt2*tt2) - tt2 * (x1*x1 + y1*y1 - tt1*tt1);q = atan (B / A);ac = acos (D / sqrt (A*A + B*B));if (sign > 0)p = q + ac;elsep = q - ac;r = (x1*x1 + y1*y1 - tt1*tt1) / (2 * (x1 * cos (p) + y1 * sin (p) + tt1));xx = cos (p) * r;yy = sin (p) * r;cout << xx + px << endl << yy + py<< endl << endl;}int main (){inti, j, k;while (fin >> t[1]){t[1] /= 1e6;for (int h = 2; h < 5; h++){fin >> t[h];t[h] /= 1e6;}for (int h = 1; h < 5; h++)if (fabs (t[h] - 0) < 1e-6){switch (h){case 1: cal (-1, t[2], t[4], 300, 0, 300, -450, 0, 450);break;case 2: cal (-1, t[1], t[3], -300, 0, -300, -450,300, 450);break;case 3: cal (1, t[1], t[2], 0, 450, 300, 450, 0, 0);break;case 4: cal (1, t[1], t[2], -300, 450, 0, 450, 300, 0);break;}break;}}system ("pause");return 0;}声源定位#include #include using namespace std;#define Max 50int N=10;double xi[10];doubleyi[10];doubleti[10][3];doubledet(double a[Max][Max],int n){inti,j,start;doublek,temp,result=1;for(start=0;start<=n-2;start++){i=1;while(a[start][start]==0&&start+i<=n-1){for(j=start;j<=n-1;j++){temp=-1*a[start][j];a[start][j]=a[start+i][j];a[start+i][j]=temp;}i++;}if(start+i==n) continue;for(i=start+1;i<=n-1;i++){k=a[i][start]/a[start][start];for(j=start;j<=n-1;j++)a[i][j]=a[i][j]-k*a[start][j];}}for(i=0;i<=n-1;i++)result*=a[i][i];return result;}intequalation(double a[Max][Max+1],double r[Max],int n){doubledet(dou