%CENA vrne ceno izgradnje predorov
%C=CENA(X,G);
%X=[x;y] je pozicija skladisca,
%G=[x1,x2,...,xn;y1,y2,...,yn] je matrika koordinat 
%gradbisc
function C=cena(X,G);
  C=sum(sum([G(1,:)-X(1);G(2,:)-X(2)].^2));
