Calculations/MOT Capture Process Simulation/+Helper/calculateDistanceFromPointToLine.m

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 = norm(CrossProduct) / norm(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