Python Sympy:优雅解决动态直线交点的实时追踪

247 阅读2分钟

最近在做一个数学的动画时,遇到一个需求。
简单来说,就是一个直线l1l_1在移动时,它与另一个直线l2l_2的交点如何定位?

制作动画的时候,当直线l1l_1移动时,需要不断重新计算它与l2l_2的新交点,然后在动画中渲染出来。

1. 问题描述

任意点AABB确定一条直线l1l_1,点CCDD确定一条直线l2l_2
两直线的交点OO
1.gif
当点BB移动时,动态绘制交点OO的变化。

2. 解决方法

解决的思路不难,首先计算交点OO的坐标,
1-1. 根据点A(x1,y1)A(x_1, y_1)和点B(x2,y2)B(x_2, y_2)可以计算出直线l1l_1的方程(y=k1x+b1y = k_1x+b_1
1-2. 根据点C(x3,y3)C(x_3, y_3)和点D(x4,y4)D(x_4, y_4)可以计算出直线l2l_2的方程(y=k2x+b2y = k_2x+b_2
1-3. 根据l1l_1的方程和l2l_2的方程可以计算出点OO的坐标

当点BB不断变化时:
2-1. 根据点AA和不断变化的点BB重新计算l1l_1的方程(y=k1x+b1y = k_1x+b_1
2-2. 根据l1l_1l2l_2的方程不断重新计算点OO的坐标

这里麻烦的地方在于需要推导出下面2个公式,然后用代码来实现:

  1. 根据两个点的坐标推导出直线方程中的斜率kk和截距bb
  2. 根据两条直线的方程推导出交点坐标

如果用Python Sympy库的话,那么一下就简单很多了。

2.1. 两点坐标求直线

根据两点坐标推导出直线斜率kk和截距bb

from sympy import Symbol, solve

def get_line(p1, p2):
    k = Symbol("k")
    b = Symbol("b")

    # 代入点p1坐标
    expr1 = p1[0] * k + b - p1[1]
    # 代入点p2坐标
    expr2 = p2[0] * k + b - p2[1]

    ret = solve((expr1, expr2), dict=True)
    return {"k": ret[0][k], "b": ret[0][b]}

2.2. 两条直线求交点

根据两条直线的斜率kk和截距bb推导交点的坐标:

def cross_point(l1, l2):
    x = Symbol("x")
    y = Symbol("y")

    # 直线l1的方程
    expr1 = l1["k"] * x + l1["b"] - y
    # 直线l2的方程
    expr2 = l2["k"] * x + l2["b"] - y
    ret = solve((expr1, expr2), dict=True)

    return np.array((float(ret[0][x]), float(ret[0][y]), 0))

2.3. 实现效果

利用上面两个函数,可以很容易得到两条直线交点的坐标,渲染后的效果如下:
2.gif

3. 总结

利用Sympy带来的最大便利在于不需要推导公式,只要列出方程,交由Sympy去推导结果即可。
这样,我们在编写一些几何方面的运算时,并不需要了解多少数学的知识,也不用去记住那些求根公式等等。

同时,也可以大大简化代码,比如上面示例中封装的两个函数(get_linecross_point),
可以看出,不仅实现的代码很简短,可读性也提高很多,几乎不需要多少数学知识就能看懂。