寻找方向角theta值

时间:2018-10-30 10:55:45

标签: python math angle

我有两个角度(以度数为单位,限制为0-359),我想找到两个角度之间的方向差,所需的数量最少。

例如:

  1. 0, 359将是-1(左1),而不是+359
  2. 180, 2将是-178(左178),而不是+182

我找到了一些代码,可以让我在没有方向的情况下找到差异。我应该如何修改它以使其定向工作?

180 - abs(abs(old - new) - 180)

1 个答案:

答案 0 :(得分:2)

我首先开始步行,比较了两种可能的旋转方式:

def nearest_signed(old, new):
    angles = ((new - old)%360, (new - old)%360 - 360)
    return min(angles, key=abs)

我们检查360度模的角度,以及它在另一个方向的补角。

似乎可行:

>>> nearest_signed(0, 359)
-1
>>> nearest_signed(359, 0)
1
>>> nearest_signed(180, 2)
-178
>>> nearest_signed(2, 180)
178

现在,我想看看它的行为,所以我绘制了每个角度组合的图:

import numpy as np
matplotlib.pyplot as plt                   

news,olds = np.ogrid[:360, :360]
rights = (news - olds) % 360
lefts = rights - 360
take_rights = abs(rights) < abs(lefts)
nearest_signed = np.where(take_rights, rights, lefts)

fig,ax = plt.subplots()
cf = ax.contourf(news.ravel(), olds.ravel(), nearest_signed, cmap='viridis', levels=np.linspace(-180, 180, 100), vmin=-180, vmax=180)
ax.set_xlabel('new angle')
ax.set_ylabel('old angle')
cb = plt.colorbar(cf, boundaries=(-180, 180))
plt.show()

pretty plotted result

现在,很明显,应该对角度差异进行简单的模运算。而且足够肯定:

>>> np.array_equal((news - olds + 180) % 360 - 180, nearest_signed)
True

您要查找的公式是

(new - old + 180) % 360 - 180

请在您的约定中采用或签署不同的符号。如果您以相反的方式计算旋转符号,只需切换两个角度:

(old - new + 180) % 360 - 180