1、#include #include const int n=3; void inverse (double cnn); templatevoid transpose (t1*mat1,t2*mat2,int a,int b); templatevoid multi(t1*mat1,t2 * mat2,t2 * result,int a,int b,int c); templatevoid input (t*mat,int a,int b); templatevoid output(t*mat,char*s,int a,int b); void main() double x=0,y=0,z=0

2、; double at34,a ta33,xg31,a tl31; double a1,a2,a3,b1,b2,b3,c1,c2,c3,l1,l2,l3,l4,l5,l6,l7,l8,l9,l10,l11,l12,lx1,ly1,lx2,ly2; double a10,a20,a30,b10,b20,b30,c10,c20,c30; float r,w,k; printf( 輸入 r:n); scanf(%f,&r); printf( 輸入 w:n); scanf(%f,&w); printf( 輸入 k:n); scanf(%f,&k); a1=cos(r)*cos(

3、k)-sin(r)*sin(w)*sin(k); a2=-cos(r)*sin(k)-sin(r)*sin(w)*cos(k); a3=-sin(r)*cos(w); b1=cos(w)*sin(k); b2=cos(w)*cos(k); b3=-sin(w); c1=sin(r)*cos(k)+cos(r)*sin(w)*sin(k); c2=-sin(r)*sin(k)+cos(r)*sin(w)*cos(k); c3=cos(r)*cos(w); float r1,w1,k1; printf( 輸入 r1:n); scanf(%f,&r1); printf( 輸入 w1:n);

4、scanf(%f,&w1); printf( 輸入 k1:n); scanf(%f,&k1); a10=cos(r)*cos(k)-sin(r)*sin(w)*sin(k); a20=-cos(r)*sin(k)-sin(r)*sin(w)*cos(k); a30=-sin(r)*cos(w); b10=cos(w)*sin(k); b20=cos(w)*cos(k); b30=-sin(w); c10=sin(r)*cos(k)+cos(r)*sin(w)*sin(k); c20=-sin(r)*sin(k)+cos(r)*sin(w)*cos(k); c30=cos(r)*

5、cos(w); double x0=0.0,y0=0.0,f=0.15324; double x1=-86.15,y1=-68.99,x2=0.0,y2=0.0; double xs=393795.45,ys=27476.46,zs=7572.69; l1=f*b1+(x1-x0)*a3; l2=f*a1+(x1-x0)*b3; l3=f*c1+(x1-x0)*c3; lx1=f*a1*xs+f*b1*ys+f*c1*zs+(x1-x0)*a3*xs+(x1-x0)*b3*ys+(x1-x0)*c3*zs; l4=f*a2+(y1-y0)*a3; l5=f*b2+(y1-y0)*b3; l6=

6、f*c2+(y1-y0)*c3; ly1=f*a2*xs+f*b2*ys+f*c2*zs+(y1-y0)*a3*xs+(y1-y0)*b3*ys+(y1-y0)*c3*zs; l7=f*b10+(x2-x0)*a30; l8=f*a10+(x2-x0)*b30; l9=f*c10+(x2-x0)*c30; lx2=f*a10*xs+f*b10*ys+f*c10*zs+(x2-x0)*a30*xs+(x2-x0)*b30*ys+(x2-x0)*c30*zs; l10=f*a20+(y2-y0)*a30; l11=f*b20+(y2-y0)*b30; l12=f*c20+(y2-y0)*c30;

7、ly2=f*a20*xs+f*b20*ys+f*c20*zs+(y2-y0)*a30*xs+(y2-y0)*b30*ys+(y2-y0)*c30*zs; double a43=l1,l2,l3,l4,l5,l6,l7,l8,l9,l10,l11,l12; double l41=lx1,ly1,lx2,ly2; transpose(a,at,3,4); multi(at,a,ata,3,4,3); inverse(ata); multi(at,l,a tl,3,4,1); multi(ata,atl,xg ,3,3,1); x=xg00; y=xg10; z=xg20; printf(x=%lf

8、,y=%lf,z=%lfn,x,y ,z); void inverse(double cnn) int i,j,h,k; double p; double qn6; for(i=0;in;i+)/ 構造高斯矩陣for(j=0;jn;j+) qij=cij; for(i=0;in;i+) for(j=n;j6;j+) if(i+3=j) qij=1; else qij=0; for(h=k=0;kn-1;k+,h+)/ 消去對角線以下的數據for(i=k+1;in;i+) if(qih=0) continue; p=qkh/qih; for(j=0;j0;k-,h-) / 消去對角線以上的數據f

9、or(i=k-1;i=0;i-) if(qih=0) continue; p=qkh/qih; for(j=0;j6;j+) qij*=p; qij-=qkj; for(i=0;in;i+)/ 將對角線上數據化為 1 p=1.0/qii; for(j=0;j6;j+) qij*=p; for(i=0;in;i+) / 提取逆矩陣for(j=0;jn;j+) cij=qij+3; templatevoid transpose(t1*mat1,t2*mat2,int a,int b) int i,j; for(i=0;ib;i+) for(j=0;ja;j+) mat2ji=mat1ij; return; templatevoid multi(t1*mat