|
|
|
@ -2777,15 +2777,6 @@ void Vehicle::guidedModeOrbit(const QGeoCoordinate& centerCoord, double radius,
@@ -2777,15 +2777,6 @@ void Vehicle::guidedModeOrbit(const QGeoCoordinate& centerCoord, double radius,
|
|
|
|
|
return; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
double lat, lon, alt; |
|
|
|
|
if (centerCoord.isValid()) { |
|
|
|
|
lat = lon = alt = qQNaN(); |
|
|
|
|
} else { |
|
|
|
|
lat = centerCoord.latitude(); |
|
|
|
|
lon = centerCoord.longitude(); |
|
|
|
|
alt = amslAltitude; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
if (capabilityBits() && MAV_PROTOCOL_CAPABILITY_COMMAND_INT) { |
|
|
|
|
sendMavCommandInt(defaultComponentId(), |
|
|
|
|
MAV_CMD_DO_ORBIT, |
|
|
|
@ -2795,7 +2786,7 @@ void Vehicle::guidedModeOrbit(const QGeoCoordinate& centerCoord, double radius,
@@ -2795,7 +2786,7 @@ void Vehicle::guidedModeOrbit(const QGeoCoordinate& centerCoord, double radius,
|
|
|
|
|
qQNaN(), // Use default velocity
|
|
|
|
|
0, // Vehicle points to center
|
|
|
|
|
qQNaN(), // reserved
|
|
|
|
|
lat, lon, alt); |
|
|
|
|
centerCoord.latitude(), centerCoord.longitude(), amslAltitude); |
|
|
|
|
} else { |
|
|
|
|
sendMavCommand(defaultComponentId(), |
|
|
|
|
MAV_CMD_DO_ORBIT, |
|
|
|
@ -2804,7 +2795,7 @@ void Vehicle::guidedModeOrbit(const QGeoCoordinate& centerCoord, double radius,
@@ -2804,7 +2795,7 @@ void Vehicle::guidedModeOrbit(const QGeoCoordinate& centerCoord, double radius,
|
|
|
|
|
qQNaN(), // Use default velocity
|
|
|
|
|
0, // Vehicle points to center
|
|
|
|
|
qQNaN(), // reserved
|
|
|
|
|
lat, lon, alt); |
|
|
|
|
centerCoord.latitude(), centerCoord.longitude(), amslAltitude); |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|