浅谈osgEarth操控器类的createLocalCoordFrame函数如何将局部坐标系的点转为世界坐标系下的Martix(ENU坐标)

编程入门 行业动态 更新时间:2024-10-28 14:28:21

浅谈osgEarth操控器类的createLocalCoordFrame函数如何将局部<a href=https://www.elefans.com/category/jswz/34/1768665.html style=坐标系的点转为世界坐标系下的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坐标)

本文发布于:2024-03-05 08:45:33,感谢您对本站的认可!
本文链接:https://www.elefans.com/category/jswz/34/1711837.html
版权声明:本站内容均来自互联网,仅供演示用,请勿用于商业和其他非法用途。如果侵犯了您的权益请与我们联系,我们将在24小时内删除。
本文标签:坐标系   浅谈   坐标   如何将   局部

发布评论

评论列表 (有 0 条评论)
草根站长

>www.elefans.com

编程频道|电子爱好者 - 技术资讯及电子产品介绍!