Cedric Roux
56c66c09aa
Pre-ci test passed git-svn-id: http://svn.eurecom.fr/openair4G/trunk@4000 818b1a75-f10b-46b9-bf7c-635c3b92a50f
42 lines
1.1 KiB
Matlab
42 lines
1.1 KiB
Matlab
function [dist, dist_travelled] = calc_dist(MS_Lat, MS_Long, site)
|
|
% [dist, dist_traveled] = calc_dist(MS_Lat, MS_Long)
|
|
% Calculates distance from Base Station as well as distance travelled in km.
|
|
% We take the reference of the BS in Cordes
|
|
% Source http://itouchmap.com/latlong.html
|
|
|
|
if nargin<3
|
|
site = 'cordes';
|
|
end
|
|
|
|
switch(site)
|
|
case 'cordes'
|
|
BS_Lat = 44.084015;
|
|
BS_Long = 1.965765;
|
|
case 'penne'
|
|
BS_Lat = 44.079722;
|
|
BS_Long = 1.714722;
|
|
case 'ambialet'
|
|
BS_Lat = 43.945;
|
|
BS_Long = 2.373889;
|
|
end
|
|
|
|
|
|
dist = zeros(1,length(MS_Lat));
|
|
for i = 1:length(MS_Lat)
|
|
if (MS_Lat(i)~=0 && MS_Long(i)~=0)
|
|
dist(i) = Dist_Calc_from_GPS(BS_Lat, BS_Long, MS_Lat(i), MS_Long(i));
|
|
else
|
|
dist(i) = nan;
|
|
end
|
|
end
|
|
|
|
dist_travelled = zeros(1,length(MS_Lat));
|
|
for i = 2:length(MS_Lat);
|
|
if (MS_Lat(i-1)~=0 && MS_Long(i-1)~=0 && MS_Lat(i)~=0 && MS_Long(i)~=0)
|
|
dist_travelled(i) = Dist_Calc_from_GPS(MS_Lat(i-1), MS_Long(i-1), MS_Lat(i), MS_Long(i));
|
|
else
|
|
dist_travelled(i) = nan;
|
|
end
|
|
end
|
|
dist_travelled = cumsum(dist_travelled);
|