计算点到曲线段的距离

import numpy as np
import matplotlib.pyplot as plt

# 绘图参数设置
plt.rcParams['font.sans-serif'] = ['SimHei']  # 步骤一(替换sans-serif字体)
plt.rcParams['axes.unicode_minus'] = False  # 步骤二(解决坐标轴负数的负号显示问题)
# 计算点point到点line_point1, line_point2组成向量的距离
# 对于曲线1上的点,找到曲线2上离其最近的两个点,求曲线1上的点到这两个最近点之间的距离
def point_distance_line(x1, y1, x2, y2, label):
    # x1, y1 曲线2
    # x2, y2 曲线1
    val = dict(zip(x1, y1))
    dis_list = []
    for point in np.array(tuple(zip(x2, y2))):
        xx = point[0]
        zzy = point[1]
        val_list = list(x1)
        val_list.append(xx)  # 将曲线1上的点添加到曲线点中,找到距离该点最近的两个点
        sort_val = sorted(val_list)
        # 如果当前点是最后一个点,取其前两个点
        if sort_val.index(xx) == len(val_list) - 1:
            lind = sort_val.index(xx) - 1
            rind = sort_val.index(xx) - 2
        # 如果当前点是第一个点,取其后两个点
        elif sort_val.index(xx) == 0:
            lind = sort_val.index(xx) + 1
            rind = sort_val.index(xx) + 2
        # 否则,取其前一个点和后一个点
        else:
            lind = sort_val.index(xx) - 1
            rind = sort_val.index(xx) + 1

        plx = sort_val[lind]
        prx = sort_val[rind]
        ply = val[plx]
        pry = val[prx]
        line_point1 = np.array([plx, ply])
        line_point2 = np.array([prx, pry])

        mfy = ply + ((xx - plx) * (pry - ply)) / (prx - plx)   # 曲线1横坐标代入曲线2对应直线后得到的纵坐标

        # 计算向量
        vec1 = line_point1 - point
        vec2 = line_point2 - point
        # 求距离
        distance = np.abs(np.cross(vec1, vec2)) / np.linalg.norm(line_point1 - line_point2)
        # label等于0 ,曲线2纵坐标小于曲线1纵坐标
        if label == 0:
            if zzy >= mfy:
                dis_list.append(distance)
            else:
                dis_list.append(-distance)
        # label等于1  曲线2纵坐标大于曲线1纵坐标
        elif label == 1:
            if zzy <= mfy:
                dis_list.append(distance)
            else:
                dis_list.append(-distance)
    return dis_list


x1 = np.arange(1, 10)
y1 = 2 * np.log(x1)

x2 = np.arange(1, 10)
y2 = 2 * np.log(x1) + np.random.random()
plt.plot(x1, y1, 'r-o', label = '曲线2')
plt.plot(x2, y2, 'b-*', label = '曲线1')
plt.legend()
plt.grid(alpha = 3)
plt.show()
print(point_distance_line(x1, y1, x2, y2, label=0))
print(point_distance_line(x1, y1, x2, y2, label=1))
————————————————
版权声明:本文为CSDN博主「青梦&amp;心河」的原创文章,遵循CC 4.0 BY-SA版权协议,转载请附上原文出处链接及本声明。
原文链接:https://blog.csdn.net/weixin_43771999/article/details/121543099
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值