|
楼主 |
发表于 2008-10-9 17:17:08
|
显示全部楼层
用这个公式效果基本一致是,也是稍有偏移。
//计算公式见:肖业伦.航空航天器建模.北京航空航天大学出版社.2003,
//第4章圆球大地情况下的飞行器的运动方程,第40页
// 地球坐标系(地心坐标系,地心赤道旋转坐标系,中心地球固连坐标系)
// 从经纬高计算空间直角坐标xyz
//SphericalToCartesian
void CoordinateCentralEarth_LonLatH2xyz( double lon, double lat, double alt,
double& x, double& y, double& z )
{
const double ReH=EARTH_RADIUS + alt;
double lon_rad=lon/180.0 *M_PI;
double lat_rad=lat/180.0 *M_PI;
z=(ReH)*sin(lat_rad);
x=(ReH)*cos(lat_rad)*cos(lon_rad);
y=(ReH)*cos(lat_rad)*sin(lon_rad);
} |
|