测量平差程序设计
角度(度分秒)到弧度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;