請教個演算法實作。資料有點暈。
知道GPS三個坐標點 A,B,C.
A 興趣點。 B 為前一個經過點, C 為當前車的位置點。
前進方向就是 B 到 C的 方向(這個就是車頭方向)。 求 A點相對于 C 的角度(不是以真北為參照,相當于車頭方向為“北”)。
簡單的用方位角相減,再處理負數。發現。很多情況不對。有經驗的大俠,麻煩給個演算法實作。列舉了太多。頭暈。但是發現其實可能都是一
個三角形內。每次感覺快想出來了,就是沒想出來。實在頭疼,只能放棄了。
uj5u.com熱心網友回復:
計算角度余弦值啊,然后反三角計算角度。uj5u.com熱心網友回復:
先根據余弦定理,計算出角ACB的大小,然后再計算線段CB與C車頭方向的夾角,根據這兩個就能計算總角了。不過中間的判斷情況可能還挺多種。uj5u.com熱心網友回復:
用向量計算比較簡單。A、B、C都用向量描述;ABC均為世界坐標。
則:B-C 為當前的方向D。C-A為車與興趣點的偏移O,求D與O的點積,就可以獲取夾角了。
轉載請註明出處,本文鏈接:https://www.uj5u.com/qita/38451.html
標籤:數據結構與算法
下一篇:求助這種坐標點集匹配演算法
