一个公式求解

问题1：求虚线和x轴的夹角
向量AB=（x2-x1,y2-y1,z2-z1）=(a1,b1,c1)
向量BC=(x3-x2,y3-y2,z3-z2)=(a2,b2,c2)
求得AB与BC构成的平面的法向量：
n=（b1* c2-b2* c1,-(a1* c2-a2* c1),a1* b2-a2*b1)
或者求解三点中心O=(x5,y5,z5)
联立求解：
(x5-x1)(x5-x1)+(y5-y1)(y5-y1)+(z5-z1)(z5-z1)=L *L
(x5-x2)(x5-x2)+(y5-y2)(y5-y2)+(z5-z2)(z5-z2)=L *L
(x5-x3)(x5-x3)+(y5-y3)(y5-y3)+(z5-z3)(z5-z3)=L *L
在得到向量DO=（x5-x4,y5-y4,z5-z4）
OD等价于n
求的夹角的余弦
取x轴的一个向量X=(1,0,0)
求得余弦值为|cos<n,X>|=|X·DO/(|X||DO|)|

问题2：将三点左边换位经纬度和高度，点D不固定在点abc平面的垂线上求，机头与正北3夹角
经纬度知识：
参考链接

取赤道为x轴，本初子午线为y轴，构造一个z轴垂直该两点且过地球中心点，那A,B,C,D坐标为，R为地球周长，h分别为各点高度，Lng 为各点经度，Lat 为各点纬度，
A=（（R-h1）cosLat 1 cosLng 1,（R-h1） * cosLat 1 * sinLng 1,（R-h1） sinLat 1 ）
B=（（R-h2） cosLat 2 * cosLng 2,（R-h2）* cosLat 2 * sinLng 2,（R-h2）* sinLat 2）
C=（（R-h3）* cosLat 3 * cosLng 3,（R-h3）* cosLat 3 * sinLng 3,（R-h3）* sinLat 3）
D=（（R-h4）* cosLat 4 * cosLng 4,（R-h4）* cosLat 4 * sinLng 4,（R-h4）* sinLat 4）
参考问题一求得平面ABC法向量n
n=（b1 * c2-b2 * c1,-(a1* c2-a2* c1),a1* b2-a2*b1)
参考问题1求得DO
叶片与机头夹角余弦值：|cos<n,DO>|=|n·DO/(|n||DO|)|
正北方向向量N
过点D，且经度不变的点，即：lng=arctan(Y/X），
取N=（1,tan(lng）,0)
与正北方向余弦值：cos<N,DO>=n·DO/(|n||DO|)