测量平差程序设计

角度(度分秒)到弧度AngleToRadian

#define PI 3double AngleToRadian(double angle)

{

int D，M；

double S,radian,degree, angle,MS；

D=int(angle+0.3)；

MS=angle-D；

M=int((MS)*100+0.3)；

S=(MS*100-M)*100;

degree=D+M/60.0+S/3600.0;

radian=degree*PI/180.0;

return radian;

}

注意:防止数据溢出,要加个微小量,例如0.3.

弧度换角度(度分秒) RadianToAngle

#define PI 3double RadianToAngle(double radian)

{

int D,M;

double S,radian,degree,MS,angle;

degree=radian*180/PI;

D=int(degree);

MS=degree-D;

M=int(MS*60);

S=(MS*60-M)*60;

angle=D+M/100.0+S/10000.0;

return angle;

}

已知两点求坐标方位角Azimuth

#include

double Azimuth(double xi,double yi,double xj,double yj)

{

double Dx,Dy,S,T;

Dx=xj-xi;

Dy=yj-yi;

S=sqrt(Dx*Dx+Dy*Dy);

if(S<1e-10) return 0;

T=asin(Dy/S);

if(Dx<0) T=PI-T;

if(Dx>0&&(Dy<0)||T<0) T=2*PI+T;

return T;

}

4.开辟二维数组的动态空间的宏

#include

#define NewArray2D(type,A,i,n,m){A=(type**)malloc(n*sizeof(type*));\

for(i=0;i

A[i]=(type*)malloc(m*sizeof(type));\

}

5.释放开辟的二维数组的空间

#define FreeSpace(A,i,m){for(i=0;i

free(A[i]);\

free(A);\

}

注意:释放空间与开辟空间相反,释放空间是先释放列,后释放行.

6.矩阵求转置transformmatrix

void transformmatrix(double **A，double **B，int i,int j)

{

int m,n;

for(m=0;m<=i;m++)

for(n=0;n<=j;n++)

{

B[n][m]=A[m][n]:

}

}

7.矩阵相乘(mulmatrix)

void mulmatrix(double **A,double **B,double **C,int i,int j,int k)

{

int m,n,p;

for(m=0;m

for(n=0;n

{

C[m][n]=0;

for(p=0;p

{

C[m][n]+=A[m][p]*B[p][n]:

}

}

}

8.矩阵求逆(countermatrix)

#include

void countermatrix(double **T, double **s, double **r, double **Q,double **N, double **rt,int n)

{

for(i=0;i

{

s=N[i][i];

for(k=0;k

{

s-=T[k][i]*T[k][i];

}

T[i][i]=sqrt(s)

for(j=i+1;j

{

s=N[i][j];

for(k=0;k

{

s-=T[k][i]*T[k][j];

}

T[i][j]=s/T[i][i];

}

}

for(i=0;i

for(j=0;j

{

T[i][j]=0;

}

for(i=n-1;i>=0;i++)

{

r[i][i]=1/T[i][i];

for(j=i+1;j

{

s=0;