def interpolate_angle(ang1, ang2, percentage=0): a1 = 0 a2 = (ang2 - ang1) % (2 * pi)
percentage = int(round(percentage, 5) * 100)
if a2 < pi:
range = np.linspace(a1, a2, 101)
else:
range = np.linspace(a2, (2 * pi), 101)
range = range[::-1] # reverse order
new_angle = (range[percentage] + ang1) % (2 * pi) # #
if (pi + 0.01) <= a2 <= (pi - 0.01):
new_angle = ang1
return new_angle