先根据距离dis和俯仰角利用勾股定理计算出水平距离d水平,
d水平 = dis * cos(angley / 180.0 * PI);
目标经度= 光电经度+ (d水平* sin(anglex)) / (EARTH_ARC * cos(lat弧度));
目标纬度= 光电纬度+ (d水平* cos(anglex)) / EARTH_ARC;
其中d水平为距离,单位km,anglex为方位角弧度,EARTH_ARC为地球平均半径弧度=
6371.393*PI/180.0,lat弧度 为光电纬度弧度值
目标高度h=设备高度+目标距离*sin(俯仰角)
aimheight = localheight + sin(angley / 180.0 * PI) * dis;