点到直线垂足坐标c语言,平面坐标里计算点到线段的垂足问题

如图，以左上为原点的坐标图，坐标都为正

已知任意直线的点A,B， 和直线外一点C

目前用向量法还是直线方程的方法，然后都有偏移的情况 。

向量法结果在A点，直线方程结果在CB线上。

(另外线AB方向是不确定的，可能是AB也可能是BA, 可能是各种方向上)

现在的方法有时是正常的，有时是错误的， 图上是错误时的用例

向量法// 求垂足座标, C(x0,y0), A(x1, y1) B(x2, y2)

func VerticalAix(x0, y0, x1, y1, x2, y2 int) (int, int) {

dx := x1 - x2

dy := y1 - y2

if math.Abs(float64(dx)) < 0.00000001 && math.Abs(float64(dy)) < 0.00000001 {

return x0, y0

}

u := (x0-x1)*(x1-x2) +

(y0-y1)*(y1-y2)

u = u / ((dx * dx) + (dy * dy))

x := x1 + u*dx

y := y1 + u*dy

return x, y

}

直线方程// 求垂足座标 C(x0,y0), A(x1, y1) B(x2, y2)

func VerticalAix(x0, y0, x1, y1, x2, y2 int) (int, int) {

if x2-x1 == 0 {

return x2, y0

}

// 算斜率

k1 := (y2 - y1) / (x2 - x1)

// 垂足x坐标

x := (math.Pow(float64(k1), 2)*float64(x1) + float64(k1*(y0-y1)) + float64(x0)) / (math.Pow(float64(k1), 2) + 1)

y := float64(k1)*(x-float64(x1)) + float64(y1)

return int(x), int(y)

}