航向和目標點之間的方位角和距離

Question

我想用三個座標爲arduino導航來計算航向點和航向點與目標點之間的距離。

座標系看起來像這樣。

（X1，Y1）=航向點，（X3，Y3）=目標點

任何幫助這裏？

Answer 1

所有的計算方法可以在this site找到。

注意的距離，你可以有半正弦波計算（不太精確）或文森特計算（外觀極好的精度 - 檢查公式here）

我用這些公式與Google地圖API和作品不錯。