大地坐标系转换为地心空间直角坐标系

void Blh2XYZ(double B, double L, double H, double *x, double *y, double *z)//B,L,H 大地坐标,单位是：度;X,Y,Z 地心空间直角坐标系，单位为：米
{  /*****大地坐标系转换为WGS84地心空间直角坐标系*****/
//大地坐标系转换为WGS84坐标系
B = B*PI / 180;
L = L*PI / 180;
double a = 6378137.0;
double b = 6356752.314;                  //a：长轴，b：短轴
double ee = (a*a - b*b) / (a*a);             // ee：e平方,e:偏心率
double w = sqrt(1 - ee*sin(B)*sin(B));
double N = a / w;


*x = (N + H)*cos(B)*cos(L);
*y = (N + H)*cos(B)*sin(L);
*z = (N - N*ee + H)*sin(B);
}