XYZ2ENU.M
上传用户:sfyaiting
上传日期:2009-10-25
资源大小:320k
文件大小:1k
源码类别:

GPS编程

开发平台:

Matlab

  1. function [e,n,u] = xyz2enu(phi,lambda,x,y,z)
  2. %XYZ2ENU  Transformation of [x;y;z] vector from geocentric to local
  3. %      system. The local system has origin at (phi, lambda) 
  4. %         that are given in degrees
  5. %Kai Borre 21-07-99
  6. %Copyright (c) by Kai Borre
  7. %$Revision: 2.0 $  $Date: 2001/10/28  $
  8. phi = phi*pi/180;
  9. lambda = lambda*pi/180;
  10. cl = cos(lambda);  sl = sin(lambda);
  11. cb = cos(phi);     sb = sin(phi);
  12. F = [-sl -sb*cl cb*cl;
  13.       cl -sb*sl cb*sl;
  14.       0   cb      sb];
  15. local_vect = F'*[x; y; z];
  16. e = local_vect(1);
  17. n = local_vect(2);
  18. u = local_vect(3);
  19. %%%%%%%%% end xyz2enu.m %%%%%%%%%