局部坐标系和世界坐标系的关系

通常矩阵是用4*4表示

其中

a11 a12 a13 通常用来表示物体的x坐标轴信息

a21 a22 a23 通常用来表示物体的y坐标轴信息

a31 a32 a33 通常用来表示物体的z坐标轴信息

a41 a42 a43 通常用来表示物体的原点坐标位置

a14 a24 a34 通常用来表示物体的平移部分
 

局部坐标系和世界坐标系的关系

当物体在世界坐标系下进行变换位置,需要一个变换矩阵

矩阵*矩阵的逆=单位矩阵

其中

局部坐标系:M局

世界坐标系:M世

局部转世界坐标系的转换矩阵:T转

物体位置发生变换的变换矩阵:V变

求变换后的局部矩阵

 

T转是不会变化的。设新的局部矩阵为:M新局

M局 * T转=M世;

T转 =(M局^-1)   *  M世;    (1)  //转换矩阵=局部矩阵的逆矩阵*世界矩阵

(M局*T转)*V变= M世*V变

M新局*T转=M世*V变                   //新的局部矩阵*局部转世界矩阵=世界矩阵*世界变换矩阵

M新局=M世*V变*(T转^-1); (2)

有1、2式可以求出变换的局部矩阵

  • 1
    点赞
  • 3
    收藏
    觉得还不错? 一键收藏
  • 1
    评论
以下是使用C++实现经纬度坐标转VVLH坐标的示例代码,其中使用WGS84椭球模型作为参考系统和参考点: ```cpp #include <cmath> // 地球半长轴 const double a = 6378137.0; // 地球扁率 const double f = 1.0 / 298.257223563; // 地球短半轴 const double b = a * (1.0 - f); // 地球第一偏心率的平方 const double e2 = (a * a - b * b) / (a * a); // 将经纬度坐标转换为地心直角坐标系(ECEF坐标系) void llh2ecef(double lat, double lon, double alt, double& x, double& y, double& z) { double sin_lat = sin(lat); double cos_lat = cos(lat); double sin_lon = sin(lon); double cos_lon = cos(lon); double N = a / sqrt(1.0 - e2 * sin_lat * sin_lat); x = (N + alt) * cos_lat * cos_lon; y = (N + alt) * cos_lat * sin_lon; z = (N * (1.0 - e2) + alt) * sin_lat; } // 将地心直角坐标系的点转换为地心固定坐标系(ECI坐标系)中的点 void ecef2eci(double x, double y, double z, double jd, double& xx, double& yy, double& zz) { double GMST = 6.30038809898489 + (0.06570982441908 + 1.00273790935 * jd) * jd; double cos_GMST = cos(GMST); double sin_GMST = sin(GMST); xx = cos_GMST * x + sin_GMST * y; yy = -sin_GMST * x + cos_GMST * y; zz = z; } // 将地心固定坐标系(ECI坐标系)中的点转换为局部竖直方向、东西方向、南北方向(VVLH)坐标系中的点 void eci2vvlh(double x, double y, double z, double lat, double lon, double& vv, double& vl, double& vh) { double sin_lat = sin(lat); double cos_lat = cos(lat); double sin_lon = sin(lon); double cos_lon = cos(lon); vv = -sin_lat * cos_lon * x - sin_lat * sin_lon * y + cos_lat * z; vl = -sin_lon * x + cos_lon * y; vh = cos_lat * cos_lon * x + cos_lat * sin_lon * y + sin_lat * z; } // 经纬度坐标转VVLH坐标 void llh2vvlh(double lat, double lon, double alt, double jd, double& vv, double& vl, double& vh) { double x, y, z; llh2ecef(lat, lon, alt, x, y, z); ecef2eci(x, y, z, jd, x, y, z); eci2vvlh(x, y, z, lat, lon, vv, vl, vh); } ``` 使用示例: ```cpp double lat = 39.9042; // 北京的纬度 double lon = 116.4074; // 北京的经度 double alt = 50.0; // 北京的海拔高度(单位:米) double jd = 2459455.5; // 2021年9月1日的儒略日数 double vv, vl, vh; llh2vvlh(lat * M_PI / 180.0, lon * M_PI / 180.0, alt, jd, vv, vl, vh); std::cout << "vv = " << vv << ", vl = " << vl << ", vh = " << vh << std::endl; ``` 注意:这只是一个简单的示例代码,实际应用中需要考虑更多的因素,比如地球的形状、重力场、大气层等。

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论 1
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值