方位角和距离计算公式(1)