Browse Source

Fix relative and absolute altitudes

QGC4.4
DonLakeFlyer 7 years ago
parent
commit
e8e2feb797
  1. 5
      src/MissionManager/MissionController.cc

5
src/MissionManager/MissionController.cc

@ -277,7 +277,7 @@ void MissionController::convertToKMLDocument(QDomDocument& document) @@ -277,7 +277,7 @@ void MissionController::convertToKMLDocument(QDomDocument& document)
return;
}
float altitude = missionJson[_jsonPlannedHomePositionKey].toArray()[2].toDouble();
float homeAltitude = missionJson[_jsonPlannedHomePositionKey].toArray()[2].toDouble();
QString coord;
QStringList coords;
@ -292,11 +292,12 @@ void MissionController::convertToKMLDocument(QDomDocument& document) @@ -292,11 +292,12 @@ void MissionController::convertToKMLDocument(QDomDocument& document)
qgcApp()->toolbox()->missionCommandTree()->getUIInfo(_controllerVehicle, item->command());
if (uiInfo && uiInfo->specifiesCoordinate() && !uiInfo->isStandaloneCoordinate()) {
double amslAltitude = item->param7() + (item->frame() == MAV_FRAME_GLOBAL ? 0 : homeAltitude);
coord = QString::number(item->param6(),'f',7) \
+ "," \
+ QString::number(item->param5(),'f',7) \
+ "," \
+ QString::number(item->param7() + altitude,'f',2);
+ QString::number(amslAltitude,'f',2);
coords.append(coord);
}
}

Loading…
Cancel
Save