坐标系的点转为世界坐标系下的Martix(ENU坐标)"/>
浅谈osgEarth操控器类的createLocalCoordFrame函数如何将局部坐标系的点转为世界坐标系下的Martix(ENU坐标)
在osgEarth操控器类的EarthManipulator中的如下函数:
void EarthManipulator::setLookAt(const osg::Vec3d& center,double azim,double pitch,double range,const osg::Vec3d& posOffset)
{setCenter( center );.... // 其它代码略
}void EarthManipulator::setCenter( const osg::Vec3d& worldPos )
{_center = worldPos;createLocalCoordFrame( worldPos, _centerLocalToWorld );.... // 其它代码略
}
如上代码在osgEarth操控器EarthManipulator类的setLookAt函数调setCenter函数设置相机视点看向的位于地球上的某焦点区域的中心_center。_center是世界坐标系表示的点,也即是地心地固坐标系表示的点。setCenter函数调用createLocalCoordFrame函数,其代码如下:
bool
EarthManipulator::createLocalCoordFrame( const osg::Vec3d& worldPos, osg::CoordinateFrame& out_frame ) const
{if ( _srs.valid() ){osg::Vec3d mapPos;_srs->transformFromWorld( worldPos, mapPos );_srs->createLocalToWorld( mapPos, out_frame );}return _srs.valid();
}
其中:
_srs->transformFromWorld( worldPos, mapPos );
是将地心地固坐标系表示的点worldPos转为经度、纬度、高程坐标系(一般为WGS84)下的点,并保存到mapPos变量中。按上面的调用流程来看,就是将_center转为经纬度、高程坐标系下的坐标,并保存到mapPos变量中。如下代码:
_srs->createLocalToWorld( mapPos, out_frame );
将mapPos变即最开始的_center转为经纬度高程后的坐标再转为out_frame。上述createLocalToWorld函数到底是干什么用的呢?断点跟踪到底层代码:
bool
SpatialReference::createLocalToWorld(const osg::Vec3d& xyz, osg::Matrixd& out_local2world ) const
{if (!valid())return false;if ( isProjected() && !isCube() ){....// 其它代码略}else if ( isGeocentric() ){....// 其它代码略}else{// convert to ECEF:osg::Vec3d ecef;if ( !transform(xyz, getGeocentricSRS(), ecef) )return false;// and create the matrix.out_local2world = _ellipsoid.geocentricToLocalToWorld(ecef);}return true;
}
在else语句中又将经纬度、高程坐标系下的_center转回地心地固坐标,接下来通过geocentricToLocalToWorld将这个地心地固坐标下的_center进行转换:
osg::Matrix
Ellipsoid::geocentricToLocalToWorld(const osg::Vec3d& geoc) const
{osg::Matrix m;EMputeLocalToWorldTransformFromXYZ(geoc.x(), geoc.y(), geoc.z(), m);return m;
}
发现上述代码调用了osg里面的函数:
inline void EllipsoidModel::computeLocalToWorldTransformFromXYZ(double X, double Y, double Z, osg::Matrixd& localToWorld) const
{double latitude, longitude, height;convertXYZToLatLongHeight(X,Y,Z,latitude,longitude,height);localToWorld.makeTranslate(X,Y,Z);computeCoordinateFrame(latitude, longitude, localToWorld);
}
这个函数前面很简单:又将地心地固坐标的_center转成经纬度、高程坐标系坐标;这个函数后面断点跟进去如下:
inline void EllipsoidModel::computeCoordinateFrame(double latitude, double longitude, osg::Matrixd& localToWorld) const
{// Compute up vectorosg::Vec3d up ( cos(longitude)*cos(latitude), sin(longitude)*cos(latitude), sin(latitude));// Compute east vectorosg::Vec3d east (-sin(longitude), cos(longitude), 0);// Compute north vector = outer product up x eastosg::Vec3d north = up ^ east;// set matrixlocalToWorld(0,0) = east[0];localToWorld(0,1) = east[1];localToWorld(0,2) = east[2];localToWorld(1,0) = north[0];localToWorld(1,1) = north[1];localToWorld(1,2) = north[2];localToWorld(2,0) = up[0];localToWorld(2,1) = up[1];localToWorld(2,2) = up[2];
}
可以看出,上面这个函数就是生成了一个旋转矩阵,再结合上面的那个平移的代码:
localToWorld.makeTranslate(X,Y,Z);
可以看出,生成的这个矩阵是一个旋转平移矩阵。而且是先旋转,后平移。 上面坐标结合下图很容易理解:
图1 坐标转换图
经过这么多转换后,_center向东、向北,向天方向的姿态就出来了,如下:
图2 ECEF、ENU、BLH坐标系
淡绿色坐标系为东北天(ENU)坐标系,经过这么多次转换后,_center就相当于三个淡绿色坐标系的原点(说明:在osgEarth操控器中,程序初始流程刚进入时,_center其实是位于图2中的1位置处,即地心地固坐标系Y轴负半轴和赤道圆交点处,这里为了便于观察,将ENU放到易于观察的角度了)。另外:图2中灰色的X、Y、Z轴表示的地心地固坐标系(ECEF),桔黄色表示的是经纬度坐标系(BLH)。
地心地固坐标系和ENU坐标系之间的换算,可以参考如下博文:
地心地固坐标系(ECEF)与站心坐标系(ENU)的转换。
参考链接:
osgearth 代码 hack(一) GeoTransfrom 如何工作
更多推荐
浅谈osgEarth操控器类的createLocalCoordFrame函数如何将局部坐标系的点转为世界坐标系下的Martix(ENU坐标)
发布评论