角度距离方向.cpp

普通平差程序

#include <stdlib.h>
#include <math.h>
#define PI 3.14159265357929

double d_h(double x)
{
	int f;
	if(x<0){
		f=-1;x=-x;}
	double x1,x2,x3,x4,x5,x6;
	x1=floor(x);
	x2=x-x1;
	x3=floor(x2*100);
	x4=(x2*100-x3)*100;
	x5=x1+x3/60+x4/3600;
	x6=x5*PI/180;
	if(f==-1) x6=-x6;
	return x6;
}
double h_d(double x)
{
	int f;
	if(x<0){
		f=-1;x=-x;}
	double x1,x2,x3,x4,x5,x6;
    x1=x*180/PI;
	x2=floor(x1);
	x3=x1-x2;
	x4=floor(x3*60);//minite value
	x5=(x3*60-x4)*60;//second value
	x6=x2+x4/100+x5/10000;
	if(f==-1) x6=-x6;
	return x6;
}

double dire(double x1,double y1,double x2,double y2)
{ 
	double x,y;
	x=x2-x1;
	y=y2-y1;
	if(x!=0)
	{
		if(x>0 && y>=0)
		   return (atan(y/x));
	    if(x>0 && y<0)
		return (atan(y/x)+2*PI);
        if(x<0 && y<0)
			return (atan(y/x)+PI);
		if(x<0 && y>=0)
			return (atan(y/x)+PI);
	}
	if(x==0) 
	{
		 if(y>0) return PI/2.0;
	     if(y<0) return 3*PI/2.0;
	     if(y==0) return -100000000.0;
	}
}

double dist(double x1,double y1,double x2,double y2)
{ 
	double dx,dy;
	dx=x2-x1;
	dy=y2-y1;
    return sqrt(dx*dx+dy*dy);	
}