|
|
|
@ -1,24 +1,24 @@
@@ -1,24 +1,24 @@
|
|
|
|
|
/*=====================================================================
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
QGroundControl Open Source Ground Control Station |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
(c) 2009 - 2015 QGROUNDCONTROL PROJECT <http://www.qgroundcontrol.org>
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
This file is part of the QGROUNDCONTROL project |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
QGROUNDCONTROL is free software: you can redistribute it and/or modify |
|
|
|
|
it under the terms of the GNU General Public License as published by |
|
|
|
|
the Free Software Foundation, either version 3 of the License, or |
|
|
|
|
(at your option) any later version. |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
QGROUNDCONTROL is distributed in the hope that it will be useful, |
|
|
|
|
but WITHOUT ANY WARRANTY; without even the implied warranty of |
|
|
|
|
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
|
|
|
|
GNU General Public License for more details. |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
You should have received a copy of the GNU General Public License |
|
|
|
|
along with QGROUNDCONTROL. If not, see <http://www.gnu.org/licenses/>.
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
======================================================================*/ |
|
|
|
|
|
|
|
|
|
#include "FirmwarePlugin.h" |
|
|
|
@ -26,6 +26,8 @@
@@ -26,6 +26,8 @@
|
|
|
|
|
|
|
|
|
|
#include <QDebug> |
|
|
|
|
|
|
|
|
|
const char* guided_mode_not_supported_by_vehicle = "Guided mode not supported by Vehicle."; |
|
|
|
|
|
|
|
|
|
bool FirmwarePlugin::isCapable(FirmwareCapabilities capabilities) |
|
|
|
|
{ |
|
|
|
|
Q_UNUSED(capabilities); |
|
|
|
@ -35,14 +37,14 @@ bool FirmwarePlugin::isCapable(FirmwareCapabilities capabilities)
@@ -35,14 +37,14 @@ bool FirmwarePlugin::isCapable(FirmwareCapabilities capabilities)
|
|
|
|
|
QList<VehicleComponent*> FirmwarePlugin::componentsForVehicle(AutoPilotPlugin* vehicle) |
|
|
|
|
{ |
|
|
|
|
Q_UNUSED(vehicle); |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
return QList<VehicleComponent*>(); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
QString FirmwarePlugin::flightMode(uint8_t base_mode, uint32_t custom_mode) const |
|
|
|
|
{ |
|
|
|
|
QString flightMode; |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
struct Bit2Name { |
|
|
|
|
uint8_t baseModeBit; |
|
|
|
|
const char* name; |
|
|
|
@ -54,9 +56,9 @@ QString FirmwarePlugin::flightMode(uint8_t base_mode, uint32_t custom_mode) cons
@@ -54,9 +56,9 @@ QString FirmwarePlugin::flightMode(uint8_t base_mode, uint32_t custom_mode) cons
|
|
|
|
|
{ MAV_MODE_FLAG_AUTO_ENABLED, "Auto" }, |
|
|
|
|
{ MAV_MODE_FLAG_TEST_ENABLED, "Test" }, |
|
|
|
|
}; |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
Q_UNUSED(custom_mode); |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
if (base_mode == 0) { |
|
|
|
|
flightMode = "PreFlight"; |
|
|
|
|
} else if (base_mode & MAV_MODE_FLAG_CUSTOM_MODE_ENABLED) { |
|
|
|
@ -71,7 +73,7 @@ QString FirmwarePlugin::flightMode(uint8_t base_mode, uint32_t custom_mode) cons
@@ -71,7 +73,7 @@ QString FirmwarePlugin::flightMode(uint8_t base_mode, uint32_t custom_mode) cons
|
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
return flightMode; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
@ -80,9 +82,9 @@ bool FirmwarePlugin::setFlightMode(const QString& flightMode, uint8_t* base_mode
@@ -80,9 +82,9 @@ bool FirmwarePlugin::setFlightMode(const QString& flightMode, uint8_t* base_mode
|
|
|
|
|
Q_UNUSED(flightMode); |
|
|
|
|
Q_UNUSED(base_mode); |
|
|
|
|
Q_UNUSED(custom_mode); |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
qWarning() << "FirmwarePlugin::setFlightMode called on base class, not supported"; |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
return false; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
@ -96,7 +98,7 @@ int FirmwarePlugin::manualControlReservedButtonCount(void)
@@ -96,7 +98,7 @@ int FirmwarePlugin::manualControlReservedButtonCount(void)
|
|
|
|
|
bool FirmwarePlugin::adjustIncomingMavlinkMessage(Vehicle* vehicle, mavlink_message_t* message) |
|
|
|
|
{ |
|
|
|
|
Q_UNUSED(vehicle); |
|
|
|
|
Q_UNUSED(message);
|
|
|
|
|
Q_UNUSED(message); |
|
|
|
|
// Generic plugin does no message adjustment
|
|
|
|
|
return true; |
|
|
|
|
} |
|
|
|
@ -111,7 +113,7 @@ void FirmwarePlugin::adjustOutgoingMavlinkMessage(Vehicle* vehicle, mavlink_mess
@@ -111,7 +113,7 @@ void FirmwarePlugin::adjustOutgoingMavlinkMessage(Vehicle* vehicle, mavlink_mess
|
|
|
|
|
void FirmwarePlugin::initializeVehicle(Vehicle* vehicle) |
|
|
|
|
{ |
|
|
|
|
Q_UNUSED(vehicle); |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
// Generic Flight Stack is by definition "generic", so no extra work
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
@ -155,7 +157,7 @@ void FirmwarePlugin::setGuidedMode(Vehicle* vehicle, bool guidedMode)
@@ -155,7 +157,7 @@ void FirmwarePlugin::setGuidedMode(Vehicle* vehicle, bool guidedMode)
|
|
|
|
|
{ |
|
|
|
|
Q_UNUSED(vehicle); |
|
|
|
|
Q_UNUSED(guidedMode); |
|
|
|
|
qgcApp()->showMessage(QStringLiteral("Guided mode not supported by Vehicle.")); |
|
|
|
|
qgcApp()->showMessage(guided_mode_not_supported_by_vehicle); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
bool FirmwarePlugin::isPaused(const Vehicle* vehicle) const |
|
|
|
@ -169,21 +171,21 @@ void FirmwarePlugin::pauseVehicle(Vehicle* vehicle)
@@ -169,21 +171,21 @@ void FirmwarePlugin::pauseVehicle(Vehicle* vehicle)
|
|
|
|
|
{ |
|
|
|
|
// Not supported by generic vehicle
|
|
|
|
|
Q_UNUSED(vehicle); |
|
|
|
|
qgcApp()->showMessage(QStringLiteral("Guided mode not supported by Vehicle.")); |
|
|
|
|
qgcApp()->showMessage(guided_mode_not_supported_by_vehicle); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
void FirmwarePlugin::guidedModeRTL(Vehicle* vehicle) |
|
|
|
|
{ |
|
|
|
|
// Not supported by generic vehicle
|
|
|
|
|
Q_UNUSED(vehicle); |
|
|
|
|
qgcApp()->showMessage(QStringLiteral("Guided mode not supported by Vehicle.")); |
|
|
|
|
qgcApp()->showMessage(guided_mode_not_supported_by_vehicle); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
void FirmwarePlugin::guidedModeLand(Vehicle* vehicle) |
|
|
|
|
{ |
|
|
|
|
// Not supported by generic vehicle
|
|
|
|
|
Q_UNUSED(vehicle); |
|
|
|
|
qgcApp()->showMessage(QStringLiteral("Guided mode not supported by Vehicle.")); |
|
|
|
|
qgcApp()->showMessage(guided_mode_not_supported_by_vehicle); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
void FirmwarePlugin::guidedModeTakeoff(Vehicle* vehicle, double altitudeRel) |
|
|
|
@ -191,7 +193,7 @@ void FirmwarePlugin::guidedModeTakeoff(Vehicle* vehicle, double altitudeRel)
@@ -191,7 +193,7 @@ void FirmwarePlugin::guidedModeTakeoff(Vehicle* vehicle, double altitudeRel)
|
|
|
|
|
// Not supported by generic vehicle
|
|
|
|
|
Q_UNUSED(vehicle); |
|
|
|
|
Q_UNUSED(altitudeRel); |
|
|
|
|
qgcApp()->showMessage(QStringLiteral("Guided mode not supported by Vehicle.")); |
|
|
|
|
qgcApp()->showMessage(guided_mode_not_supported_by_vehicle); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
void FirmwarePlugin::guidedModeGotoLocation(Vehicle* vehicle, const QGeoCoordinate& gotoCoord) |
|
|
|
@ -199,7 +201,7 @@ void FirmwarePlugin::guidedModeGotoLocation(Vehicle* vehicle, const QGeoCoordina
@@ -199,7 +201,7 @@ void FirmwarePlugin::guidedModeGotoLocation(Vehicle* vehicle, const QGeoCoordina
|
|
|
|
|
// Not supported by generic vehicle
|
|
|
|
|
Q_UNUSED(vehicle); |
|
|
|
|
Q_UNUSED(gotoCoord); |
|
|
|
|
qgcApp()->showMessage(QStringLiteral("Guided mode not supported by Vehicle.")); |
|
|
|
|
qgcApp()->showMessage(guided_mode_not_supported_by_vehicle); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
void FirmwarePlugin::guidedModeChangeAltitude(Vehicle* vehicle, double altitudeRel) |
|
|
|
@ -207,7 +209,7 @@ void FirmwarePlugin::guidedModeChangeAltitude(Vehicle* vehicle, double altitudeR
@@ -207,7 +209,7 @@ void FirmwarePlugin::guidedModeChangeAltitude(Vehicle* vehicle, double altitudeR
|
|
|
|
|
// Not supported by generic vehicle
|
|
|
|
|
Q_UNUSED(vehicle); |
|
|
|
|
Q_UNUSED(altitudeRel); |
|
|
|
|
qgcApp()->showMessage(QStringLiteral("Guided mode not supported by Vehicle.")); |
|
|
|
|
qgcApp()->showMessage(guided_mode_not_supported_by_vehicle); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
const FirmwarePlugin::remapParamNameMajorVersionMap_t& FirmwarePlugin::paramNameRemapMajorVersionMap(void) const |
|
|
|
|