Mein MATLAB Forum

%
function [UTC lat_A lat_B long_A long_B x_gps velocity course] = GPS()

% create a object with serial port for gps device
gps = instrfind('Type','serial','Port', 'COM5', 'Tag', '');
if isempty (gps)
    gps = serial('COM5');
else
    fclose(gps);
    gps = gps(1);
end
fopen(gps); %connect object to serial port
set(gps, 'BaudRate', 57600);

info = fscanf(gps);

% get data from GPGGA (Global positioning system fix data)
while isempty(strmatch('$GPGGA',info))
    info = fscanf(gps);
end
data = textscan(info,'%s%f%f%c%f%c',1,'delimiter',',');

% compute UTC(HHMMSS.SSS), Universal Time Coordinated
hour = floor(data{2}/10000);
minute = floor((data{2}-hour*10000)/100);
second = round(data{2}-floor(data{2}/100)*100);
UTC = strcat(num2str(hour),':',num2str(minute),':',num2str(second));

%compute latitude(DDMM.MMM) and longitude(DDDMM.MMMM)
degree = floor(data{3}/100);
decimal = round((data{3}-degree*100)/60*10^6)/10^6;
lat_A = strcat(num2str(degree+decimal),data{4});

degree= floor(data{5}/100);
decimal = round((data{5}-degree*100)/60*10^6)/10^6;
long_A = strcat(num2str(degree+decimal),data{6});

% get data from GPVTG (Track made good and ground speed)
while isempty(strmatch('$GPVTG',info))
    info = fscanf(gps);
end
data = textscan(info,'%s%f%c%f%c%f%c%f%c',1,'delimiter',',');

% compute velocity(km/h) and course
velocity = data{8};
course = data{2};

% GPS-Koordinaten der Ampel
lat_B = 52;
long_B = 14;

% Entfernung zwischen GPS-Signalen
x_gps = arccos(sin(lat_B)*sin(lat_A) + cos(lat_B)*cos(lat_A)*cos(long_B - long_A));

% Display the results
disp({UTC,lat_A,long_A,lat_B,long_B,velocity, course});

end