GPS 三点， 以2点的方向为车头前进方向，计算第三点在 当前点的方位

[qq_27750831]

请教个算法实现。数据有点晕。

知道GPS三个坐标点 A,B,C.

A 兴趣点。 B 为前一个经过点， C 为当前车的位置点。

前进方向就是 B 到 C的 方向（这个就是车头方向）。 求 A点相对于 C 的角度（不是以真北为参照，相当于车头方向为“北”）。

简单的用方位角相减，再处理负数。发现。很多情况不对。有经验的大侠，麻烦给个算法实现。枚举了太多。头晕。但是发现其实可能都是一

个三角形内。每次感觉快想出来了，就是没想出来。实在头疼，只能放弃了。

[HUNTON]

计算角度余弦值啊，然后反三角计算角度。

[HUNTON]

先根据余弦定理，计算出角ACB的大小，然后再计算线段CB与C车头方向的夹角，根据这两个就能计算总角了。不过中间的判断情况可能还挺多种。

[示申○言舌]

用向量计算比较简单。 A、B、C都用向量描述；ABC均为世界坐标。 则：B-C 为当前的方向D。C-A为车与兴趣点的偏移O，求D与O的点积，就可以获取夹角了。