tscript1

Test triangulare formula (2D)

p1 = [3 8];
k1 = [1 2];
k1 = k1/norm(k1);

p2 = [-4 4];
k2 = [3 -2];
k2 = k2/norm(k2);

b = [ dot(p2-p1,k1); -dot(p2-p1,k2)];
A = [dot(k1,k1) -dot(k1,k2); -dot(k1,k2) dot(k2,k2)];
q = A\b;

pA = p1+k1*q(1)
pB = p2+k2*q(2)

pA =

   -0.2500    1.5000


pB =

   -0.2500    1.5000

qrng = [-10 10];
p = ones(2,1)*p1+qrng'*k1;
plot(p(:,1),p(:,2),'b');
hold on
p = ones(2,1)*p2+qrng'*k2;
plot(p(:,1),p(:,2),'g');
hold off

hold on
plot([pA(1) pB(1)],[pA(2) pB(2)],'mo');
hold off