经纬高坐标系与地心坐标系转化 matlab

function [XeYeZe]=LBHtoECEF（doubleitudelatitudeheight）
% 输入为经度（单位为°），纬度（单位为°），高度（单位为Km）
% 经纬高（LBH）（大地坐标系）
% 到
% 地心坐标系（ECEF）（地心为原点）
double C45;
C45=180.0/pi;
a=6378.137;             %地球长半轴
b=6356.7523142;         %地球短半轴
e=sqrt（（a*a-b*b）/a/a）;  %第一偏心率
e2=e*e;                 %第一偏心率的平方
double l