python求两条直线的交点_编程求取直线一般式表达式,两直线交点

背景介绍

最近在水面无人艇(USV)模拟仿真中,用到了一些点和线的关系求解,本文主要讲述一下两点确认直线,点到直线距离,两条直线的交点等问题的解决方法,并给出python程序。部分内容非原创,文中给出链接,需要者可以参考。

博客更新可参见github点线关系

两点确定直线

表达式定义

空间直线的表达式有多种,比如一般式Ax+By+C=0、点斜式y-y0=k(x-x0)、截距式x/a+y/b=1、两点式:(y-y1)/(y1-y2)=(x-x1)/(x1-x2)等,它们具有彼此的约束条件,如下所示。

由上可以看出来,一般式的适用范围最广,不需要单独做处理和判断,所以在计算机领域处理二维图像数据中一般式用的最多。

已知直线上的两点P1(X1,Y1)和P2(X2,Y2),P1和P2两点不重合,对于AX+BY+C=0,则有:

A=Y2-Y1

B=X1-X2

C=X2*Y1-X1*Y2

python源代码

def GeneralEquation(first_x,first_y,second_x,second_y):

# 一般式 Ax+By+C=0

# from http://www.cnblogs.com/DHUtoBUAA/

A=second_y-first_y

B=first_x-second_x

C=second_x*first_y-first_x*second_y

return A,B,C

点到直线距离

表达式定义

设直线L的方程为Ax+By+C=0,点P的坐标为(x0,y0),则点P到直线L的距离为:

d=\frac{\left | A\times x0+B\times y0+C \right |}{\sqrt{A^{2}+B^{2}}}

博客园对Markdown插入数学公式支持不友好,可以转移到看github点线关系查看最新版。如果有博客园数学公式插入方法,欢迎留言指教。

两条直线的交点

表达式定义

在已知直线两点的情况下,利用上面的直线一般式可以求得直线的参数A、B和C,那么两条直线的一般式表达可以列成二元一次方程组,其解即为两条直线的交点坐标。注意处理两条直线平行的特殊情况。

根据二元一次方程的解,假设两条直线的参数分别为A1,B1,C1和A2,B2,C2,那么两条直线的交点可以表示为:

x=\frac{C2\times B1-C1\times B2}{A1\times B2-A2\times B1}

y=\frac{C1\times A2-C2\times A1}{A1\times B2-A2\times B1}

python源代码

def GetIntersectPointofLines(x1,y1,x2,y2,x3,y3,x4,y4):

# from http://www.cnblogs.com/DHUtoBUAA/

A1,B1,C1=GeneralEquation(x1,y1,x2,y2)

A2, B2, C2 = GeneralEquation(x3,y3,x4,y4)

m=A1*B2-A2*B1

if m==0:

print("无交点")

else:

x=(C2*B1-C1*B2)/m

y=(C1*A2-C2*A1)/m

return x,y

程序运行结果:两直线交点为x=32.857142857142854,y=65.71428571428571,符合数学计算。部分内容参考自两条线段是否相交,计算交点公式。

表情包
插入表情
评论将由博主筛选后显示,对所有人可见 | 还能输入1000个字符
相关推荐
©️2020 CSDN 皮肤主题: 数字20 设计师:CSDN官方博客 返回首页