회선으로부터의 거리가 작동하지 않는다

Question

회선으로부터의 거리를 계산 중입니다. 그러나 나는 틀린 거리를 얻고있다. 다음은 줄에서 거리를 가져 오는 코드 조각입니다.

float px,py,something,u; 
px=x2-x1; 
py=y2-y1; 

something = px*px + py*py; 

u = ((x - x1) * px + (y - y1) * py) /(something); 


if(u > 1) 
{ 
    u = 1; 
    // MinDist=0; 
} 
else if (u < 0) 
{ 
    u = 0; 
    //MinDist=0; 
} 


float xx = x1 + u * px; 
float yy = y1 + u * py; 

float dx = xx - x; 
float dy = yy - y; 

float dist= (float)Math.sqrt((double)dx*dx +(double) dy*dy); 

Dist가 잘못 답하고 있습니다.

Answer 1

에서 : http://en.wikipedia.org/wiki/Distance_from_a_point_to_a_line#Vector_formulation

distance(x=a+tn, p) = ||(a-p)-((a-p).n)n|| 

장소 :

a = (x1, y1)    //First point on line 
n = |(x2-x1, y2-y1)|  //Normalised direction vector 
p = (x, y)    //Query point 

그래서, 모든 것을 할,하지만 기능을하고 포뮬러에 따라 도움이되는 의미있는 이름을 부여하지 않을 :

float[] a = new float[]{x1, y1}; 
float[] n = new float[]{x2-x1, y2-y1}; 
normalize(n); 
float[] p = new float[]{x, y}; 

float[] aMinusP = subtract(a, p); 
float aMinusPDotn = dot(aMinusP, n); 

// vec2a.vec2b 
float dot(float[] vec2a, float[] vec2b) 
{ 
    return vec2a[0]*vec2b[0] + vec2a[1]*vec2b[1]; 
} 

// ||vec2|| 
float len(float[] vec2) 
{ 
    return (float)Math.Sqrt(dot(vec2, vec2)); 
} 

// vec2/||vec2|| 
void normalize(float[] vec2) 
{ 
    float length = len(vec2); 
    vec2[0] /= length; 
    vec2[1] /= length; 
} 

// vec2a - vec2b 
float[] subtract(float[] vec2a, float[] vec2b) 
{ 
    return new float[]{vec2a[0]-vec2b[0],vec2a[1]-vec2b[1]}; 
} 

을