计算GDOP

#include <iostream>
#include <fstream>
#include "..\include\CPosition.h"
#include "..\include\Constant.h"
#include "..\include\Data.h"
#include<stdio.h>
#define MATHRES 1E-12
#define FOUR 4
typedf struct{
 
       int prn;
       XYZCoor pos;
}SVPosStruct;
int Maxsat;
int ReadSatPosFile(FILE*SVPosFile,SVPosStruct*SV);
int fun(int n);
void ComputeDOP2(XYZCoor Obs,XYZCoor SV[4],DOPStruct*DOP);
void main()
{
 
  double a=6378137.0;
  double e2=0.00669342162297;
  double PAI=3.1415926535898;
  double P0=PAI/180.0;
  double N;
  XYZCoor ObsPos;
  int LatDeg,LonDeg,LatMin,LonMin;
  float LatSec,LonSec,H,B,L;
  FILE*SVPosFile,*SVDOPFile;
  int i,j,k,ri,num;
  int array[4];
  int temp;
  XYZCoor SV[4];
  int SVNo[4];
  SVPosStruct*SVPos;
  DOPStruct DOP;
  prinf("Please Input local Lat(dd mm.mmmm):");
  scanf("%i %f",&LatDeg,&LatMin);
  B=((float)LatDeg+LatMin/60.0)*P0;
  prinf("Please Input local Lon(ddd mm.mmmm):");
  scanf("%i %f",&LonDeg,&LonMin);
  L=((float)LonDeg+LonMin/60.0)*P0;
  prinf("Please Input local Height(meter):");
  scanf("%f