我有两个角度(以度数为单位,限制为0-359
),我想找到两个角度之间的方向差,所需的数量最少。
例如:
0, 359
将是-1
(左1
),而不是+359
180, 2
将是-178
(左178
),而不是+182
我找到了一些代码,可以让我在没有方向的情况下找到差异。我应该如何修改它以使其定向工作?
180 - abs(abs(old - new) - 180)
答案 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()
现在,很明显,应该对角度差异进行简单的模运算。而且足够肯定:
>>> np.array_equal((news - olds + 180) % 360 - 180, nearest_signed)
True
您要查找的公式是
(new - old + 180) % 360 - 180
请在您的约定中采用或签署不同的符号。如果您以相反的方式计算旋转符号,只需切换两个角度:
(old - new + 180) % 360 - 180