%-----------------------------------------------------------
% Carlos Cabral 2003 - Dep.UA

% funçao para calcular a distancia entre o robot e cada um dos pilares detectados
%-----------------------------------------------------------
function [dist1, dist2] = DIST_ROBOT2PILAR(coord_pilares)
        

dist1=sqrt(coord_pilares(1,1)^2+coord_pilares(1,2)^2); % distancia do robot aos pilares 1ª pilar
dist2=sqrt(coord_pilares(2,1)^2+coord_pilares(2,2)^2); % distancia do robot aos pilares 2ª pilar