function [Distance2target1, Distance2target2,Distance2target3 ] = Distance2target3(Position,Target1Location,Target2Location,Target3Location)

if nargin == 0
    Position = [1, 4, 7];
    Target1Location = [12, 55, 29];
    Target2Location = [55, 42, 75];
    Target3Location = [55, 42, 75];
end

p = Position;
At1 = Target1Location;  % arrival to target
t1 = Target2Location;   % target
Dt1 = Target3Location;  % departure from target
Distance2target1 = sqrt((At1(1)-p(1))^2+(At1(2)-p(2))^2+(At1(3)-p(3))^2);
Distance2target2 = sqrt((t1(1)-p(1))^2+(t1(2)-p(2))^2+(t1(3)-p(3))^2);
Distance2target3 = sqrt((Dt1(1)-p(1))^2+(Dt1(2)-p(2))^2+(Dt1(3)-p(3))^2);
% Distance2target1 = D1;
% Distance2target2 = D2;