/* 功能说明： （1）将地理坐标(wd,jd)转换成绝对的高斯坐标(y,x)
    （2）本函数支持基于六度带（或三度带）、克拉索夫斯基椭球进行转换                             */
/* 适用范围： 本函数适用于将地球东半球中北半球（即东经0度到东经180度，北纬0度至90度）范围
    内所有地理坐标到高斯坐标的转换            */
/* 使用说明： 调用本函数后返回的结果应在满足精度的条件下进行四舍五入      */
// double jd;         输入参数: 地理坐标的经度，以秒为单位
// double wd;         输入参数: 地理坐标的纬度，以秒为单位
// short  DH;      输入参数: 三度带或六度带的带号
/*  六度带(三度带)的带号是这样得到的：从东经0度到东经180度自西向东按每6度(3度)顺序编号
 (编号从1开始)，这个顺序编号就称为六度带(三度带)的带号。因此，六度带的带号的范围是1-30，
 三度带的带号的范围是1-60。
  如果一个点在图号为TH的图幅中，那麽该点所处的六度带的带号就可以这样得到：将该图号的
 第3、4位组成的字符串先转换成数字，再减去30。例如某点在图幅06490701中，该点所在的带号就
 是49-30，即19。
  如果调用本函数去进行一般的从地理坐标到基于六度带高斯坐标的变换（非邻带转换），则参
 数DH的选取按前一段的方法去确定。                
  如果调用本函数去进行基于六度带邻带转换，则参数DH的选取先按上述方法去确定，然后看是
 往前一个带还是后一个带进行邻带转换再确定是加1还是减1。         */
void GeoToGauss(double jd, double wd, short DH, short DH_width, double *y, double *x, double LP)
{
 double t;     //  t=tgB
 double L;     //  中央经线的经度
 double l0;    //  经差
 double jd_hd,wd_hd;  //  将jd、wd转换成以弧度为单位
 double et2;    //  et2 = (e' ** 2) * (cosB ** 2)
 double N;     //  N = C / sqrt(1 + et2)
 double X;     //  克拉索夫斯基椭球中子午弧长
 double m;     //  m = cosB * PI/180 * l0
 double tsin,tcos;   //  sinB,cosB

 double PI=3.14159265358979;
 double b_e2=0.0067385254147;
 double b_c=6399698.90178271;

 jd_hd = jd / 3600.0 * PI / 180.0 ;    // 将以秒为单位的经度转换成弧度
 wd_hd = wd / 3600.0 * PI / 180.0 ;    // 将以秒为单位的纬度转换成弧度
 
 // 如果不设中央经线（缺省参数: -1000），则计算中央经线，
 // 否则，使用传入的中央经线，不再使用带号和带宽参数
 //L = (DH - 0.5) * DH_width ;      // 计算中央经线的经度
 if (LP == -1000)
 {
   L = (DH - 0.5) * DH_width ;      // 计算中央经线的经度
 }
 else
 {
   L = LP ;
 }

 l0 = jd / 3600.0 - L  ;       // 计算经差
 tsin = sin(wd_hd);        // 计算sinB
 tcos = cos(wd_hd);        // 计算cosB
             // 计算克拉索夫斯基椭球中子午弧长X
 X = 111134.8611 / 3600.0 * wd - (32005.7799 * tsin + 133.9238 * pow(tsin,3) 
      + 0.6976 * pow(tsin,5) + 0.0039 * pow(tsin,7) ) * tcos;
 et2 = b_e2 * pow(tcos,2) ;      //  et2 = (e' ** 2) * (cosB ** 2)
 N  = b_c / sqrt( 1 + et2 ) ;      //  N = C / sqrt(1 + et2)
 t  = tan(wd_hd);         //  t=tgB
 m  = PI/180 * l0 * tcos;       //  m = cosB * PI/180 * l0
 *x = X + N * t * ( 0.5 * pow(m,2)                                          
          + (5.0 - pow(t,2) + 9.0 * et2 + 4 * pow(et2,2)) * pow(m,4)/24.0     
          + (61.0 - 58.0 * pow(t,2) + pow(t,4)) * pow(m,6) / 720.0 ) ;
 *y = N * ( m + ( 1.0 - pow(t,2) + et2 ) * pow(m,3) / 6.0                   
                + ( 5.0 - 18.0 * pow(t,2) + pow(t,4) + 14.0 * et2             
                   - 58.0 * et2 * pow(t,2) ) * pow(m,5) / 120.0 );

}