earth.m
上传用户:skyjin520
上传日期:2016-12-06
资源大小:20k
文件大小:0k
源码类别:

交通/航空行业

开发平台:

Matlab

  1. function [wnie, wnen, RMh, RNh, gn] = earth(pos, vn)
  2. global glv
  3.     sl=sin(pos(1)); cl=cos(pos(1)); tl=sl/cl; sl2=sl*sl; sl4=sl2*sl2;
  4.     wnie = glv.wie*[0; cl; sl];
  5.     sq = 1-glv.e2*sl2; sq2 = sqrt(sq);
  6.     RMh = glv.Re*(1-glv.e2)/sq/sq2+pos(3);
  7.     RNh = glv.Re/sq2+pos(3);
  8.     wnen = [-vn(2)/RMh; vn(1)/RNh; vn(1)/RNh*tl];
  9.     g = glv.g0*(1+5.27094e-3*sl2+2.32718e-5*sl4)-3.086e-6*pos(3); % grs80
  10.     gn = [0;0;-g];