GuidedActionsController.qml 22 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30
/****************************************************************************
 *
 *   (c) 2009-2016 QGROUNDCONTROL PROJECT <http://www.qgroundcontrol.org>
 *
 * QGroundControl is licensed according to the terms in the file
 * COPYING.md in the root of the source code directory.
 *
 ****************************************************************************/

import QtQuick                  2.3
import QtQuick.Controls         1.2
import QtQuick.Controls.Styles  1.4
import QtQuick.Dialogs          1.2
import QtLocation               5.3
import QtPositioning            5.3
import QtQuick.Layouts          1.2

import QGroundControl                           1.0
import QGroundControl.ScreenTools               1.0
import QGroundControl.Controls                  1.0
import QGroundControl.Palette                   1.0
import QGroundControl.Vehicle                   1.0
import QGroundControl.FlightMap                 1.0

/// This provides the smarts behind the guided mode commands, minus the user interface. This way you can change UI
/// without affecting the underlying functionality.
Item {
    id: _root

    property var missionController
31
    property var confirmDialog
DonLakeFlyer's avatar
DonLakeFlyer committed
32
    property var actionList
Don Gagne's avatar
Don Gagne committed
33
    property var altitudeSlider
34
    property var orbitMapCircle
35

36
    readonly property string emergencyStopTitle:            qsTr("EMERGENCY STOP")
37 38
    readonly property string armTitle:                      qsTr("Arm")
    readonly property string disarmTitle:                   qsTr("Disarm")
39
    readonly property string rtlTitle:                      qsTr("Return")
40 41 42
    readonly property string takeoffTitle:                  qsTr("Takeoff")
    readonly property string landTitle:                     qsTr("Land")
    readonly property string startMissionTitle:             qsTr("Start Mission")
43
    readonly property string mvStartMissionTitle:           qsTr("Start Mission (MV)")
44 45 46
    readonly property string continueMissionTitle:          qsTr("Continue Mission")
    readonly property string resumeMissionUploadFailTitle:  qsTr("Resume FAILED")
    readonly property string pauseTitle:                    qsTr("Pause")
47
    readonly property string mvPauseTitle:                  qsTr("Pause (MV)")
48 49 50 51
    readonly property string changeAltTitle:                qsTr("Change Altitude")
    readonly property string orbitTitle:                    qsTr("Orbit")
    readonly property string landAbortTitle:                qsTr("Land Abort")
    readonly property string setWaypointTitle:              qsTr("Set Waypoint")
52
    readonly property string gotoTitle:                     qsTr("Go To Location")
53
    readonly property string vtolTransitionTitle:           qsTr("VTOL Transition")
54

55 56
    readonly property string armMessage:                        qsTr("Arm the vehicle.")
    readonly property string disarmMessage:                     qsTr("Disarm the vehicle")
57
    readonly property string emergencyStopMessage:              qsTr("WARNING: THIS WILL STOP ALL MOTORS. IF VEHICLE IS CURRENTLY IN THE AIR IT WILL CRASH.")
58 59 60
    readonly property string takeoffMessage:                    qsTr("Takeoff from ground and hold position.")
    readonly property string startMissionMessage:               qsTr("Takeoff from ground and start the current mission.")
    readonly property string continueMissionMessage:            qsTr("Continue the mission from the current waypoint.")
Don Gagne's avatar
Don Gagne committed
61
    readonly property string resumeMissionUploadFailMessage:    qsTr("Upload of resume mission failed. Confirm to retry upload")
62
    readonly property string landMessage:                       qsTr("Land the vehicle at the current position.")
63
    readonly property string rtlMessage:                        qsTr("Return to the launch position of the vehicle.")
64
    readonly property string changeAltMessage:                  qsTr("Change the altitude of the vehicle up or down.")
DonLakeFlyer's avatar
DonLakeFlyer committed
65
    readonly property string gotoMessage:                       qsTr("Move the vehicle to the specified location.")
66
             property string setWaypointMessage:                qsTr("Adjust current waypoint to %1.").arg(_actionData)
Don Gagne's avatar
Don Gagne committed
67
    readonly property string orbitMessage:                      qsTr("Orbit the vehicle around the specified location.")
68
    readonly property string landAbortMessage:                  qsTr("Abort the landing sequence.")
69
    readonly property string pauseMessage:                      qsTr("Pause the vehicle at it's current position, adjusting altitude up or down as needed.")
70
    readonly property string mvPauseMessage:                    qsTr("Pause all vehicles at their current position.")
71 72
    readonly property string vtolTransitionFwdMessage:          qsTr("Transition VTOL to fixed wing flight.")
    readonly property string vtolTransitionMRMessage:           qsTr("Transition VTOL to multi-rotor flight.")
73

74 75 76 77 78 79 80 81 82 83 84 85 86 87
    readonly property int actionRTL:                        1
    readonly property int actionLand:                       2
    readonly property int actionTakeoff:                    3
    readonly property int actionArm:                        4
    readonly property int actionDisarm:                     5
    readonly property int actionEmergencyStop:              6
    readonly property int actionChangeAlt:                  7
    readonly property int actionGoto:                       8
    readonly property int actionSetWaypoint:                9
    readonly property int actionOrbit:                      10
    readonly property int actionLandAbort:                  11
    readonly property int actionStartMission:               12
    readonly property int actionContinueMission:            13
    readonly property int actionResumeMission:              14
Don Gagne's avatar
Don Gagne committed
88
    readonly property int _actionUnused:                    15
89 90
    readonly property int actionResumeMissionUploadFail:    16
    readonly property int actionPause:                      17
91 92
    readonly property int actionMVPause:                    18
    readonly property int actionMVStartMission:             19
93 94
    readonly property int actionVtolTransitionToFwdFlight:  20
    readonly property int actionVtolTransitionToMRFlight:   21
95

96 97 98
    property bool showEmergenyStop:     _guidedActionsEnabled && !_hideEmergenyStop && _vehicleArmed && _vehicleFlying
    property bool showArm:              _guidedActionsEnabled && !_vehicleArmed
    property bool showDisarm:           _guidedActionsEnabled && _vehicleArmed && !_vehicleFlying
Don Gagne's avatar
Don Gagne committed
99 100 101
    property bool showRTL:              _guidedActionsEnabled && _vehicleArmed && _activeVehicle.guidedModeSupported && _vehicleFlying && !_vehicleInRTLMode
    property bool showTakeoff:          _guidedActionsEnabled && _activeVehicle.takeoffVehicleSupported && !_vehicleFlying
    property bool showLand:             _guidedActionsEnabled && _activeVehicle.guidedModeSupported && _vehicleArmed && !_activeVehicle.fixedWing && !_vehicleInLandMode
102
    property bool showStartMission:     _guidedActionsEnabled && _missionAvailable && !_missionActive && !_vehicleFlying
103
    property bool showContinueMission:  _guidedActionsEnabled && _missionAvailable && !_missionActive && _vehicleArmed && _vehicleFlying && (_currentMissionIndex < _missionItemCount - 1)
104
    property bool showPause:            _guidedActionsEnabled && _vehicleArmed && _activeVehicle.pauseVehicleSupported && _vehicleFlying && !_vehiclePaused && !_fixedWingOnApproach
105
    property bool showChangeAlt:        _guidedActionsEnabled && _vehicleFlying && _activeVehicle.guidedModeSupported && _vehicleArmed && !_missionActive
DonLakeFlyer's avatar
DonLakeFlyer committed
106
    property bool showOrbit:            _guidedActionsEnabled && !_hideOrbit && _vehicleFlying && _activeVehicle.orbitModeSupported && !_missionActive
107
    property bool showLandAbort:        _guidedActionsEnabled && _vehicleFlying && _fixedWingOnApproach
108
    property bool showGotoLocation:     _guidedActionsEnabled && _vehicleFlying
109

110
    // Note: The '_missionItemCount - 2' is a hack to not trigger resume mission when a mission ends with an RTL item
Don Gagne's avatar
Don Gagne committed
111
    property bool showResumeMission:    _activeVehicle && !_vehicleArmed && _vehicleWasFlying && _missionAvailable && _resumeMissionIndex > 0 && (_resumeMissionIndex < _missionItemCount - 2)
112

DonLakeFlyer's avatar
DonLakeFlyer committed
113 114
    property bool guidedUIVisible:      guidedActionConfirm.visible || guidedActionList.visible

115
    property var    _corePlugin:            QGroundControl.corePlugin
Don Gagne's avatar
Don Gagne committed
116 117 118
    property var    _activeVehicle:         QGroundControl.multiVehicleManager.activeVehicle
    property bool   _guidedActionsEnabled:  (!ScreenTools.isDebug && QGroundControl.corePlugin.options.guidedActionsRequireRCRSSI && _activeVehicle) ? _rcRSSIAvailable : _activeVehicle
    property string _flightMode:            _activeVehicle ? _activeVehicle.flightMode : ""
119
    property bool   _missionAvailable:      missionController.containsItems
Don Gagne's avatar
Don Gagne committed
120 121 122 123
    property bool   _missionActive:         _activeVehicle ? _vehicleArmed && (_vehicleInLandMode || _vehicleInRTLMode || _vehicleInMissionMode) : false
    property bool   _vehicleArmed:          _activeVehicle ? _activeVehicle.armed  : false
    property bool   _vehicleFlying:         _activeVehicle ? _activeVehicle.flying  : false
    property bool   _vehicleLanding:        _activeVehicle ? _activeVehicle.landing  : false
124 125 126 127
    property bool   _vehiclePaused:         false
    property bool   _vehicleInMissionMode:  false
    property bool   _vehicleInRTLMode:      false
    property bool   _vehicleInLandMode:     false
128
    property int    _missionItemCount:      missionController.missionItemCount
129
    property int    _currentMissionIndex:   missionController.currentMissionIndex
130 131 132
    property int    _resumeMissionIndex:    missionController.resumeMissionIndex
    property bool   _hideEmergenyStop:      !QGroundControl.corePlugin.options.guidedBarShowEmergencyStop
    property bool   _hideOrbit:             !QGroundControl.corePlugin.options.guidedBarShowOrbit
133
    property bool   _vehicleWasFlying:      false
134
    property bool   _rcRSSIAvailable:       _activeVehicle ? _activeVehicle.rcRSSI > 0 && _activeVehicle.rcRSSI <= 100 : false
135
    property bool   _fixedWingOnApproach:   _activeVehicle ? _activeVehicle.fixedWing && _vehicleLanding : false
136

137
    // You can turn on log output for GuidedActionsController by turning on GuidedActionsControllerLog category
Don Gagne's avatar
Don Gagne committed
138 139
    property bool __guidedModeSupported:    _activeVehicle ? _activeVehicle.guidedModeSupported : false
    property bool __pauseVehicleSupported:  _activeVehicle ? _activeVehicle.pauseVehicleSupported : false
140
    property bool __flightMode:             _flightMode
141 142

    function _outputState() {
143
        if (_corePlugin.guidedActionsControllerLogging()) {
Don Gagne's avatar
Don Gagne committed
144
            console.log(qsTr("_activeVehicle(%1) _vehicleArmed(%2) guidedModeSupported(%3) _vehicleFlying(%4) _vehicleWasFlying(%5) _vehicleInRTLMode(%6) pauseVehicleSupported(%7) _vehiclePaused(%8) _flightMode(%9) _missionItemCount(%10)").arg(_activeVehicle ? 1 : 0).arg(_vehicleArmed ? 1 : 0).arg(__guidedModeSupported ? 1 : 0).arg(_vehicleFlying ? 1 : 0).arg(_vehicleWasFlying ? 1 : 0).arg(_vehicleInRTLMode ? 1 : 0).arg(__pauseVehicleSupported ? 1 : 0).arg(_vehiclePaused ? 1 : 0).arg(_flightMode).arg(_missionItemCount))
Gus Grubba's avatar
Gus Grubba committed
145 146 147 148 149 150 151
        }
    }

    Connections {
        target: mainWindow
        onActiveVehicleChanged: {
            _outputState()
152
        }
153 154
    }

155 156 157 158 159 160 161
    Component.onCompleted:              _outputState()
    on_VehicleArmedChanged:             _outputState()
    on_VehicleInRTLModeChanged:         _outputState()
    on_VehiclePausedChanged:            _outputState()
    on__FlightModeChanged:              _outputState()
    on__GuidedModeSupportedChanged:     _outputState()
    on__PauseVehicleSupportedChanged:   _outputState()
162
    on_MissionItemCountChanged:         _outputState()
163

DonLakeFlyer's avatar
DonLakeFlyer committed
164
    on_CurrentMissionIndexChanged: {
165
        if (_corePlugin.guidedActionsControllerLogging()) {
DonLakeFlyer's avatar
DonLakeFlyer committed
166 167 168 169
            console.log("_currentMissionIndex", _currentMissionIndex)
        }
    }
    on_ResumeMissionIndexChanged: {
170
        if (_corePlugin.guidedActionsControllerLogging()) {
DonLakeFlyer's avatar
DonLakeFlyer committed
171 172 173
            console.log("_resumeMissionIndex", _resumeMissionIndex)
        }
    }
174
    onShowResumeMissionChanged: {
175
        if (_corePlugin.guidedActionsControllerLogging()) {
176 177
            console.log("showResumeMission", showResumeMission)
        }
178 179 180
        _outputState()
    }
    onShowStartMissionChanged: {
181
        if (_corePlugin.guidedActionsControllerLogging()) {
182 183
            console.log("showStartMission", showStartMission)
        }
184 185 186
        _outputState()
    }
    onShowContinueMissionChanged: {
187
        if (_corePlugin.guidedActionsControllerLogging()) {
188 189
            console.log("showContinueMission", showContinueMission)
        }
190 191
        _outputState()
    }
Don Gagne's avatar
Don Gagne committed
192 193 194 195 196 197
    onShowRTLChanged: {
        if (_corePlugin.guidedActionsControllerLogging()) {
            console.log("showRTL", showRTL)
        }
        _outputState()
    }
198 199
    // End of hack

200
    on_VehicleFlyingChanged: {
201
        _outputState()
202 203 204 205 206 207
        if (!_vehicleFlying) {
            // We use _vehicleWasFLying to help trigger Resume Mission only if the vehicle actually flew and came back down.
            // Otherwise it may trigger during the Start Mission sequence due to signal ordering or armed and resume mission index.
            _vehicleWasFlying = true
        }
    }
DonLakeFlyer's avatar
DonLakeFlyer committed
208 209

    property var _actionData
210 211

    on_FlightModeChanged: {
Don Gagne's avatar
Don Gagne committed
212 213 214 215
        _vehiclePaused =        _activeVehicle ? _flightMode === _activeVehicle.pauseFlightMode : false
        _vehicleInRTLMode =     _activeVehicle ? _flightMode === _activeVehicle.rtlFlightMode || _flightMode === _activeVehicle.smartRTLFlightMode : false
        _vehicleInLandMode =    _activeVehicle ? _flightMode === _activeVehicle.landFlightMode : false
        _vehicleInMissionMode = _activeVehicle ? _flightMode === _activeVehicle.missionFlightMode : false // Must be last to get correct signalling for showStartMission popups
216
    }
217 218

    // Called when an action is about to be executed in order to confirm
219
    function confirmAction(actionCode, actionData, mapIndicator) {
220
        var showImmediate = true
221
        closeAll()
222 223
        confirmDialog.action = actionCode
        confirmDialog.actionData = actionData
224
        confirmDialog.hideTrigger = true
225
        confirmDialog.mapIndicator = mapIndicator
DonLakeFlyer's avatar
DonLakeFlyer committed
226
        confirmDialog.optionText = ""
227 228 229
        _actionData = actionData
        switch (actionCode) {
        case actionArm:
230
            if (_vehicleFlying || !_guidedActionsEnabled) {
231 232
                return
            }
233 234 235
            confirmDialog.title = armTitle
            confirmDialog.message = armMessage
            confirmDialog.hideTrigger = Qt.binding(function() { return !showArm })
236 237
            break;
        case actionDisarm:
238
            if (_vehicleFlying) {
239 240
                return
            }
241 242 243
            confirmDialog.title = disarmTitle
            confirmDialog.message = disarmMessage
            confirmDialog.hideTrigger = Qt.binding(function() { return !showDisarm })
244 245
            break;
        case actionEmergencyStop:
246 247 248
            confirmDialog.title = emergencyStopTitle
            confirmDialog.message = emergencyStopMessage
            confirmDialog.hideTrigger = Qt.binding(function() { return !showEmergenyStop })
249 250
            break;
        case actionTakeoff:
251 252 253
            confirmDialog.title = takeoffTitle
            confirmDialog.message = takeoffMessage
            confirmDialog.hideTrigger = Qt.binding(function() { return !showTakeoff })
254
            altitudeSlider.setToMinimumTakeoff()
255
            altitudeSlider.visible = true
256 257
            break;
        case actionStartMission:
258
            showImmediate = false
259 260 261
            confirmDialog.title = startMissionTitle
            confirmDialog.message = startMissionMessage
            confirmDialog.hideTrigger = Qt.binding(function() { return !showStartMission })
262
            break;
263
        case actionMVStartMission:
264
            confirmDialog.title = mvStartMissionTitle
265 266 267
            confirmDialog.message = startMissionMessage
            confirmDialog.hideTrigger = true
            break;
268
        case actionContinueMission:
269
            showImmediate = false
270 271 272 273
            confirmDialog.title = continueMissionTitle
            confirmDialog.message = continueMissionMessage
            confirmDialog.hideTrigger = Qt.binding(function() { return !showContinueMission })
            break;
274
        case actionResumeMission:
Don Gagne's avatar
Don Gagne committed
275 276
            // Resume Mission is handled in mission end dialog
            return
277 278 279 280 281
        case actionResumeMissionUploadFail:
            confirmDialog.title = resumeMissionUploadFailTitle
            confirmDialog.message = resumeMissionUploadFailMessage
            confirmDialog.hideTrigger = Qt.binding(function() { return !showResumeMission })
            break;
282
        case actionLand:
283 284 285
            confirmDialog.title = landTitle
            confirmDialog.message = landMessage
            confirmDialog.hideTrigger = Qt.binding(function() { return !showLand })
286 287
            break;
        case actionRTL:
288 289
            confirmDialog.title = rtlTitle
            confirmDialog.message = rtlMessage
Don Gagne's avatar
Don Gagne committed
290
            if (_activeVehicle.supportsSmartRTL) {
DonLakeFlyer's avatar
DonLakeFlyer committed
291 292 293
                confirmDialog.optionText = qsTr("Smart RTL")
                confirmDialog.optionChecked = false
            }
294
            confirmDialog.hideTrigger = Qt.binding(function() { return !showRTL })
295 296
            break;
        case actionChangeAlt:
297 298 299
            confirmDialog.title = changeAltTitle
            confirmDialog.message = changeAltMessage
            confirmDialog.hideTrigger = Qt.binding(function() { return !showChangeAlt })
Don Gagne's avatar
Don Gagne committed
300 301
            altitudeSlider.reset()
            altitudeSlider.visible = true
302 303
            break;
        case actionGoto:
304 305 306
            confirmDialog.title = gotoTitle
            confirmDialog.message = gotoMessage
            confirmDialog.hideTrigger = Qt.binding(function() { return !showGotoLocation })
307 308
            break;
        case actionSetWaypoint:
309 310
            confirmDialog.title = setWaypointTitle
            confirmDialog.message = setWaypointMessage
311 312
            break;
        case actionOrbit:
313 314 315
            confirmDialog.title = orbitTitle
            confirmDialog.message = orbitMessage
            confirmDialog.hideTrigger = Qt.binding(function() { return !showOrbit })
DonLakeFlyer's avatar
DonLakeFlyer committed
316 317
            altitudeSlider.reset()
            altitudeSlider.visible = true
318 319
            break;
        case actionLandAbort:
320 321 322
            confirmDialog.title = landAbortTitle
            confirmDialog.message = landAbortMessage
            confirmDialog.hideTrigger = Qt.binding(function() { return !showLandAbort })
323 324
            break;
        case actionPause:
325 326 327
            confirmDialog.title = pauseTitle
            confirmDialog.message = pauseMessage
            confirmDialog.hideTrigger = Qt.binding(function() { return !showPause })
328 329
            altitudeSlider.reset()
            altitudeSlider.visible = true
330
            break;
331
        case actionMVPause:
332
            confirmDialog.title = mvPauseTitle
333 334 335
            confirmDialog.message = mvPauseMessage
            confirmDialog.hideTrigger = true
            break;
336 337 338 339 340 341 342 343 344 345
        case actionVtolTransitionToFwdFlight:
            confirmDialog.title = vtolTransitionTitle
            confirmDialog.message = vtolTransitionFwdMessage
            confirmDialog.hideTrigger = true
            break
        case actionVtolTransitionToMRFlight:
            confirmDialog.title = vtolTransitionTitle
            confirmDialog.message = vtolTransitionMRMessage
            confirmDialog.hideTrigger = true
            break
346 347 348
        default:
            console.warn("Unknown actionCode", actionCode)
            return
349
        }
350
        confirmDialog.show(showImmediate)
351 352 353
    }

    // Executes the specified action
DonLakeFlyer's avatar
DonLakeFlyer committed
354
    function executeAction(actionCode, actionData, actionAltitudeChange, optionChecked) {
355 356
        var i;
        var rgVehicle;
357 358
        switch (actionCode) {
        case actionRTL:
Don Gagne's avatar
Don Gagne committed
359
            _activeVehicle.guidedModeRTL(optionChecked)
360 361
            break
        case actionLand:
Don Gagne's avatar
Don Gagne committed
362
            _activeVehicle.guidedModeLand()
363 364
            break
        case actionTakeoff:
Don Gagne's avatar
Don Gagne committed
365
            _activeVehicle.guidedModeTakeoff(actionAltitudeChange)
366 367
            break
        case actionResumeMission:
368
        case actionResumeMissionUploadFail:
369
            missionController.resumeMission(missionController.resumeMissionIndex)
370 371
            break
        case actionStartMission:
372
        case actionContinueMission:
Don Gagne's avatar
Don Gagne committed
373
            _activeVehicle.startMission()
374
            break
375
        case actionMVStartMission:
376 377 378
            rgVehicle = QGroundControl.multiVehicleManager.vehicles
            for (i = 0; i < rgVehicle.count; i++) {
                rgVehicle.get(i).startMission()
379 380
            }
            break
381
        case actionArm:
Don Gagne's avatar
Don Gagne committed
382
            _activeVehicle.armed = true
383 384
            break
        case actionDisarm:
Don Gagne's avatar
Don Gagne committed
385
            _activeVehicle.armed = false
386 387
            break
        case actionEmergencyStop:
Don Gagne's avatar
Don Gagne committed
388
            _activeVehicle.emergencyStop()
389 390
            break
        case actionChangeAlt:
Don Gagne's avatar
Don Gagne committed
391
            _activeVehicle.guidedModeChangeAltitude(actionAltitudeChange)
392 393
            break
        case actionGoto:
Don Gagne's avatar
Don Gagne committed
394
            _activeVehicle.guidedModeGotoLocation(actionData)
395 396
            break
        case actionSetWaypoint:
Don Gagne's avatar
Don Gagne committed
397
            _activeVehicle.setCurrentMissionSequence(actionData)
398 399
            break
        case actionOrbit:
Don Gagne's avatar
Don Gagne committed
400
            _activeVehicle.guidedModeOrbit(orbitMapCircle.center, orbitMapCircle.radius() * (orbitMapCircle.clockwiseRotation ? 1 : -1), _activeVehicle.altitudeAMSL.rawValue + actionAltitudeChange)
401 402
            break
        case actionLandAbort:
Don Gagne's avatar
Don Gagne committed
403
            _activeVehicle.abortLanding(50)     // hardcoded value for climbOutAltitude that is currently ignored
404 405
            break
        case actionPause:
Don Gagne's avatar
Don Gagne committed
406 407
            _activeVehicle.pauseVehicle()
            _activeVehicle.guidedModeChangeAltitude(actionAltitudeChange)
408
            break
409
        case actionMVPause:
410 411 412
            rgVehicle = QGroundControl.multiVehicleManager.vehicles
            for (i = 0; i < rgVehicle.count; i++) {
                rgVehicle.get(i).pauseVehicle()
413 414
            }
            break
415
        case actionVtolTransitionToFwdFlight:
Don Gagne's avatar
Don Gagne committed
416
            _activeVehicle.vtolInFwdFlight = true
417 418
            break
        case actionVtolTransitionToMRFlight:
Don Gagne's avatar
Don Gagne committed
419
            _activeVehicle.vtolInFwdFlight = false
420
            break
421 422 423 424 425 426
        default:
            console.warn(qsTr("Internal error: unknown actionCode"), actionCode)
            break
        }
    }
}