所有参数已知的情况下解算无人机拍摄图片各像素点的经纬度 cpp代码

以下是一个简单的示例代码，假设您已经知道了以下参数：

1. 无人机的GPS坐标（经度，纬度）
2. 无人机的飞行高度
3. 拍摄图片的分辨率（宽度，高度）
4. 拍摄图片的视角（水平和垂直）

#include <iostream>
#include <cmath>

#define PI 3.14159265358979323846

using namespace std;

// 计算经纬度
void calcLatLon(double droneLat, double droneLon, double droneAlt, double imgWidth, double imgHeight, double imgHFOV, double imgVFOV, double i, double j, double& lat, double& lon) {
    double H = droneAlt; // 飞机高度
    double W = H * tan(imgHFOV / 2 * PI / 180) * 2; // 水平视角对应的宽度
    double h = H * tan(imgVFOV / 2 * PI / 180) * 2; // 垂直视角对应的高度
    double deltaLat = h / imgHeight; // 单位像素高度对应的纬度差
    double deltaLon = W / imgWidth; // 单位像素宽度对应的经度差

    lat = droneLat + (i - imgHeight / 2) * deltaLat; // 计算像素点的纬度
    lon = droneLon + (j - imgWidth / 2) * deltaLon; // 计算像素点的经度
}

int main() {
    double droneLat = 31.2304; // 无人机的纬度
    double droneLon = 121.4737; // 无人机的经度
    double droneAlt = 100; // 无人机的飞行高度
    double imgWidth = 1920; // 拍摄图片的宽度
    double imgHeight = 1080; // 拍摄图片的高度
    double imgHFOV = 60; // 拍摄图片的水平视角
    double imgVFOV = 30; // 拍摄图片的垂直视角

    // 计算像素点的经纬度
    double lat, lon;
    calcLatLon(droneLat, droneLon, droneAlt, imgWidth, imgHeight, imgHFOV, imgVFOV, 960, 540, lat, lon);
    cout << "Pixel (960, 540) is located at (" << lat << ", " << lon << ")" << endl;

    return 0;
}

在上面的示例代码中，`calcLatLon`函数可以计算给定像素点的经纬度。在这个函数中，我们首先根据无人机的飞行高度和拍摄图片的视角计算出一个像素对应的经度和纬度差值，然后根据像素点的坐标计算出像素点的经纬度。在`main`函数中，我们可以使用`calcLatLon`函数来计算任意一个像素点的经纬度。