后方交会程序
//后方交会程序
#include "stdio.h"
#include "math.h"
#include "iostream.h" #define N 4
#define M 2*N
void transpose(double *m1,double *m2,int m,int n) //矩阵转置
{ int i,j;
for(i=0;i>m;
// cout<<"请输入焦距(mm):f=";
// cin>>f;
/* for(i=0;i>x[i]>>y[i];
cout<<"请输入第"<<(i+1)<<"个点的地面坐标 X Y Z(m):"<>X[i]>>Y[i]>>Z[i];
S1+=X[i];
S2+=Y[i];
}*/
m=50000;f=153.24;
for(i=0;i0.00001||fabs(H[1])>0.00001||fabs(H[2])>0.00001||fabs(H[3])>0.00001||fabs(H[4])>0.00001||fabs(H[5])>0.00001) {
a[0]=cos(t)*cos(k)-sin(t)*sin(w)*sin(k);
a[1]=-cos(t)*sin(k)-sin(t)*sin(w)*cos(k);
a[2]=-sin(t)*cos(w);
b[0]=cos(w)*sin(k);
b[1]=cos(w)*cos(k);
b[2]=-sin(w);
c[0]=sin(t)*cos(k)+cos(t)*sin(w)*sin(k);
c[1]=-sin(t)*sin(k)+cos(t)*sin(w)*cos(k);
c[2]=cos(t)*cos(w);
for(i=0;i