大疆无人机实现目标定位

大疆无人机回传的实时视频可以帮助飞友观察发现美景，就称为目标吧，你偏偏对目标很感兴趣，迫切想知道目标的位置，最好是经纬度坐标。你查找大疆Document，欣喜地发现大疆提供了定位机体本身的定位方法（通过FlightController.setStateCallback重写Update函数即可），不过并没有定位目标的现成函数。 实际上，屏幕上的像素与实地坐标存在一一对应的关系，找到这个关系就能实现实地目标的定位。 建模条件：①地面为水平平面；②相机视角θ（大疆X3为94度）；③飞机相对高度droneHeight，经纬度（droneLat，droneLng），机头朝向droneHeading；④屏幕分辨率deviceWidth、deviceHeight；⑤屏幕以左上角为原点（0,0），向右向下为正；⑥相机垂直地面；⑦不考虑目标的高度和图像形变。

则任意屏幕的像素点（x,y），对应的实地经纬度坐标为唯一的，假设为（xLng,yLat），从而可以用大疆SDK提供的函数在地图中标定。 基于上述模型，得到从像素点到实地位置的计算过程： 1、根据飞机高度和相机视角，计算屏幕中的图像对应实地的长度（Height1）和宽度（Width1）: Width1=droneHeighttan(Θ/2) Height1=deviceHeightWidth1/deviceWidth； 2、计算目标像素在屏幕中相对于屏幕中心点的归一化位置（tmpX ,tmpY）,其中tmpX = droneHeightx2/Width1， tmpY = -y/x*tmpX;

3、根据飞机当前位置和机头方向，解算实地的顶点坐标： xLng=droneLng+(tmpXcos(droneHeading)- tmpYsin(droneHeading))M_TO_LAT; yLa