10 lines
456 B
Mathematica
10 lines
456 B
Mathematica
|
function ret = calculateDistanceFromPointToLine(p0 , p1, p2)
|
||
|
|
p01 = p0 - p1;
|
||
|
|
p12 = p2 - p1;
|
||
|
|
CrossProduct = [p01(2)*p12(3) - p01(3)*p12(2), p01(3)*p12(1) - p01(1)*p12(3), p01(1)*p12(2) - p01(2)*p12(1)];
|
||
|
|
ret = rssq(CrossProduct) / rssq(p12);
|
||
|
|
|
||
|
|
%Height of parallelogram (Distance between point and line) = Area of parallelogram / Base
|
||
|
|
%Area = One side of parallelogram X Base
|
||
|
|
%ret = norm(cross(one side, base))./ norm(base);
|
||
|
|
end
|