Added new target location algorithm.

Fixed issue with target altitude calculation.
This commit is contained in:
Nffj84
2024-07-16 18:15:10 +03:00
parent 46ad1f0ff7
commit 2b9bda1ff0
11 changed files with 98 additions and 47 deletions
+5 -4
View File
@@ -141,17 +141,18 @@ void RemoteControl::calculateTargetPosition(QJsonObject &commandObject)
{
qDebug().noquote().nospace() << "Getting target location";
float altitude = commandObject["altitude"].toDouble();
float latitude = commandObject["latitude"].toDouble();
float longitude = commandObject["longitude"].toDouble();
float altitude = commandObject["altitude"].toDouble();
float yaw = commandObject["yaw"].toDouble();
float pitch = commandObject["pitch"].toDouble();
float targetPixelWidth = commandObject["target_pixel_width"].toInt();
//float targetPixelWidth = commandObject["target_pixel_width"].toInt();
//float targetPixelHeight = commandObject["target_pixel_height"].toInt();
float targetRealWidth = commandObject["target_real_width"].toDouble();
//float targetRealWidth = commandObject["target_real_width"].toDouble();
//float targetRealHeight = commandObject["target_real_height"].toDouble();
GPSData gpsData = UtilsTargetLocation::getLocation(altitude, latitude, longitude, yaw, pitch, 0.0f, targetRealWidth, targetPixelWidth);
//GPSData gpsData = UtilsTargetLocation::getLocation(altitude, latitude, longitude, yaw, pitch, 0.0f, targetRealWidth, targetPixelWidth);
GPSData gpsData = UtilsTargetLocation::getLocation(altitude, latitude, longitude, yaw, pitch, 0.0f);
mResponseObject["altitude"] = gpsData.altitude;
mResponseObject["latitude"] = gpsData.latitude;
mResponseObject["longitude"] = gpsData.longitude;