7 lines
231 B
Matlab
7 lines
231 B
Matlab
function [d, dx, dy, dz] = computePointToPoints(~, agentPos, targetPos)
|
|
dx = targetPos(:,1) - agentPos(1);
|
|
dy = targetPos(:,2) - agentPos(2);
|
|
dz = targetPos(:,3) - agentPos(3);
|
|
d = sqrt(dx.^2 + dy.^2 + dz.^2);
|
|
end
|