gps 捕获 matlab,【matlab国外编程代写】GPS捕获解算matlab代码

%This Function Compute Azimuth and Elevation of satellite from reciever

%CopyRight By Moein Mehrtash

%************************************************************************ % Written by Moein Mehrtash, Concordia University, 3/21/2008 *

% Email: moeinmehrtash@http://www.doczj.com/doc/58d8bdb25fbfc77da269b1ae.html * %************************************************************************ % ================================================================== % Input : * % Pos_Rcv : XYZ position of reciever (Meter) *

% Pos_SV : XYZ matrix position of GPS satellites (Meter) *

% Output: * % E :Elevation (Rad) *

% A :Azimuth (Rad) * %************************************************************************

function [E,A]=Calc_Azimuth_Elevation(Pos_Rcv,Pos_SV);

R=Pos_SV-Pos_Rcv; %vector from Reciever to Satellite

GPS = ECEF2GPS(Pos_Rcv); %Lattitude and Longitude of Reciever

Lat=GPS(1);Lon=GPS(2);

ENU=XYZ2ENU(R,Lat,Lon);

Elevation=asin(ENU(3)/norm(ENU));

Azimuth=atan2(ENU(1)/norm(ENU),ENU(2)/norm(ENU));

E=Elevation;

A=Azimuth;

function d=Distance(Pos_SV,Pos_Rcv);

[m,n]=size(Pos_SV);

for i=1:m

d(i)=norm(Pos_SV(i,:)-Pos_Rcv);

end% ECEF2LLA - convert earth-centered earth-fixed (ECEF)

% cartesian coordinates to latitude, longitude,

% and altitude

%

% USAGE:

% [lat,lon,alt] = ECEF2GPS(x,y,z)

%

% lat = geodetic latitude (radians)

% lon = longitude (radians)

% alt = height above WGS84 ellipsoid (m)

% x = ECEF X-coordinate (m)