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