1. 程式人生 > >計算點到直線距離

計算點到直線距離

假設給定兩點P0、P1,確定一條直線,並求出某一點P到該直線的距離

設P(x0,y0),直線方程為:Ax+By+C=0
則P到直線的距離為:d=|Ax0+By0+C|/√(A²+B²)

a = y1 - y0,
b = x0 - x1,
c = x1 * y0 - x0 * y1

A = p1_y - p0_y;
B = p0_x - p1_x;
C = p1_x * p0_y - p0_x * p1_y;

dist = fabs(A * p_x + B * p_y + C) / sqrt(A * A + B *B);