python 根据坐标点计算方位角函数

# 计算方位角函数
def azimuthAngle( x1, y1, x2, y2):
  angle = 0.0;
  dx = x2 - x1
  dy = y2 - y1
  if x2 == x1:
    angle = math.pi / 2.0
    if y2 == y1 :
      angle = 0.0
    elif y2 < y1 :
      angle = 3.0 * math.pi / 2.0
  elif x2 > x1 and y2 > y1:
    angle = math.atan(dx / dy)
  elif x2 > x1 and y2 < y1 :
    angle = math.pi / 2 + math.atan(-dy / dx)
  elif x2 < x1 and y2 < y1 :
    angle = math.pi + math.atan(dx / dy)
  elif x2 < x1 and y2 > y1 :
    angle = 3.0 * math.pi / 2.0 + math.atan(dy / -dx)
  return (angle * 180 / math.pi)

#计算角度
print(white_point)
if white_point[0][0]>white_point[1][0]:
    x1=white_point[1][0];
    y1=white_point[1][1];
    x2=white_point[0][0];
    y2=white_point[0][1];
else:
    x1=white_point[0][0];
    y1=white_point[0][1];
    x2=white_point[1][0];
    y2=white_point[1][1];

angle = 90-azimuthAngle(x1,y1,x2,y2)
print("angle:"+str(angle))