求点到线段或直线的距离（不计算角度）

刀么克瑟拉莫

已于 2022-12-16 11:01:58 修改

阅读量109

点赞数

分类专栏：轮子文章标签：算法

于 2022-12-16 10:04:15 首次发布

本文链接：https://blog.csdn.net/random_repick/article/details/128338769

版权

轮子专栏收录该内容

12 篇文章 1 订阅

订阅专栏

线段

double Distance (double p1, double p2, double q1, double q2) {
    double d1 = p1-q1, d2 = p2-q2;
    return sqrt(d1*d1+d2*d2);
}

double PLSdistance(double a1, double a2, double b1, double b2, double c1, double c2) {
    // 向量ab，ac
    double ab1 = b1-a1, ab2 = b2-a2, ac1 = c1-a1, ac2 = c2-a2;
    // 内积小于0，夹角大于90度，c在ab线段外面靠近a的一侧
    double abac = ab1*ac1 + ab2*ac2;
    if(abac < 0) return Distance(a1, a2, c1, c2);
    // 内积大于ab模的平方，ac在ab方向的投影大于ab，c在ab线段外面靠近b的一侧
    double abab = ab1*ab1 + ab2*ab2;
    if(abac > abab) return Distance(b1, b2, c1, c2);
    // d是c在ab上的投影点
    abac /= abab;
    double d1 = a1+(b1-a1)*abac, d2 = a2+(b2-a2)*abac;
    return Distance(c1, c2, d1, d2);
}

直线

double PLdistance(double a1, double a2, double b1, double b2, double c1, double c2) {
    // 向量ab和ac外积的绝对值除以ab的模
    double ab1 = b1-a1, ab2 = b2-a2, ac1 = c1-a1, ac2 = c2-a2;
	double abxac = ab1*ac2 - ab2*ac1, abab = ab1*ab1 + ab2*ab2;
	if(abxac < 0) abxac = -abxac;
	return abxac / sqrt(abab);
}