如何有效地计算2d点的三个向量之间的全(2pi)角

时间:2019-06-21 21:36:11

标签: python numpy linear-algebra trigonometry

我有三个[n,2]形状的numpy数组,其中包含点列表。我们称它们为a,b和c。我想找到ab和bc之间的完整角度。使用acos只能使我获得pi弧度,但是我想要完整的2pi比例。我考虑过使用atan2,但是不确定如何计算atan2必需的y和x向量-我尝试使用向量范数,但这些方法本质上是肯定的。我有什么办法可以完全使用numpy函数来做到这一点?

2 个答案:

答案 0 :(得分:2)

仅使用arccos方法只会给您向量之间的绝对角度,而不是顺时针还是逆时针。您可以通过检查a相对于b的垂直线的点积是否为负来表示逆时针角度,来对此进行补充。

import numpy as np

def dot(a, b):
  return np.sum(a * b, axis=-1)

def mag(a):
  return np.sqrt(np.sum(a*a, axis=-1))

def angle(a, b):
  cosab = dot(a, b) / (mag(a) * mag(b)) # cosine of angle between vectors
  angle = np.arccos(cosab) # what you currently have (absolute angle)

  b_t = b[:,[1,0]] * [1, -1] # perpendicular of b

  is_cc = dot(a, b_t) < 0

  # invert the angles for counter-clockwise rotations
  angle[is_cc] = 2*np.pi - angle[is_cc]
  return angle

print(angle(
  np.array([[1, 0], [1, 0]]),
  np.array([[0, 1], [0, -1]])
))

将打印[pi/2, 3pi/2]的浮点值。

此函数在[0, 2*pi]范围内输出。

答案 1 :(得分:0)

毫不奇怪,这里可以使用angle函数。它需要一个复杂的参数x + y i

此方法的优点是可以轻松获得相对角度。使用atan2会比较棘手。

def get_angle(a,b,yx=False):
    # make sure inputs are contiguous float
    # swap x and  if requested
    a,b = map(np.ascontiguousarray, (a[...,::-1],b[...,::-1]) if yx else (a,b), (float,float))
    # view cast to complex, prune excess dimension
    A,B = (z.view(complex).reshape(z.shape[:-1]) for z in (a,b))
    # to get the relative angle we must either divide 
    # or (probably cheaper) multiply with the conjugate  
    return np.angle(A.conj()*B)

a,b,c = np.random.randn(3,20,2)
# let's look at a roundtrip as a test
get_angle(a,b)+get_angle(b,c)+get_angle(c,a)
# array([ 0.00000000e+00,  1.66533454e-16,  4.44089210e-16, -2.22044605e-16,
#         0.00000000e+00,  0.00000000e+00,  0.00000000e+00, -4.44089210e-16,
#         0.00000000e+00, -1.66533454e-16,  2.22044605e-16,  0.00000000e+00,
#         0.00000000e+00,  2.22044605e-16,  6.28318531e+00,  8.32667268e-17,
#         2.22044605e-16, -6.28318531e+00, -2.22044605e-16,  6.28318531e+00])
# some zeros, some 2pi and some -2pi ==> looks ok

# Let's also check the sum of angles of triangles abc:
get_angle(a-c,b-c)+get_angle(b-a,c-a)+get_angle(c-b,a-b)
# array([-3.14159265, -3.14159265,  3.14159265, -3.14159265, -3.14159265,
#         3.14159265, -3.14159265, -3.14159265,  3.14159265, -3.14159265,
#        -3.14159265,  3.14159265, -3.14159265, -3.14159265,  3.14159265,
#         3.14159265, -3.14159265, -3.14159265,  3.14159265,  3.14159265])
相关问题