GuidedActionsController.qml 21.7 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 39 40 41 42
    readonly property string armTitle:                      qsTr("Arm")
    readonly property string disarmTitle:                   qsTr("Disarm")
    readonly property string rtlTitle:                      qsTr("RTL")
    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 52
    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")
    readonly property string gotoTitle:                     qsTr("Goto 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 63 64
    readonly property string landMessage:                       qsTr("Land the vehicle at the current position.")
    readonly property string rtlMessage:                        qsTr("Return to the home position of the vehicle.")
    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
Gus Grubba's avatar
Gus Grubba 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)
Gus Grubba's avatar
Gus Grubba committed
104 105 106 107
    property bool showPause:            _guidedActionsEnabled && _vehicleArmed && activeVehicle.pauseVehicleSupported && _vehicleFlying && !_vehiclePaused
    property bool showChangeAlt:        _guidedActionsEnabled && _vehicleFlying && activeVehicle.guidedModeSupported && _vehicleArmed && !_missionActive
    property bool showOrbit:            _guidedActionsEnabled && !_hideOrbit && _vehicleFlying && activeVehicle.orbitModeSupported && !_missionActive
    property bool showLandAbort:        _guidedActionsEnabled && _vehicleFlying && activeVehicle.fixedWing && _vehicleLanding
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
Gus Grubba's avatar
Gus Grubba 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
Gus Grubba's avatar
Gus Grubba committed
116 117
    property bool   _guidedActionsEnabled:  (!ScreenTools.isDebug && QGroundControl.corePlugin.options.guidedActionsRequireRCRSSI && activeVehicle) ? _rcRSSIAvailable : activeVehicle
    property string _flightMode:            activeVehicle ? activeVehicle.flightMode : ""
118
    property bool   _missionAvailable:      missionController.containsItems
Gus Grubba's avatar
Gus Grubba committed
119 120 121 122
    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
123 124 125 126
    property bool   _vehiclePaused:         false
    property bool   _vehicleInMissionMode:  false
    property bool   _vehicleInRTLMode:      false
    property bool   _vehicleInLandMode:     false
127
    property int    _missionItemCount:      missionController.missionItemCount
128
    property int    _currentMissionIndex:   missionController.currentMissionIndex
129 130 131
    property int    _resumeMissionIndex:    missionController.resumeMissionIndex
    property bool   _hideEmergenyStop:      !QGroundControl.corePlugin.options.guidedBarShowEmergencyStop
    property bool   _hideOrbit:             !QGroundControl.corePlugin.options.guidedBarShowOrbit
132
    property bool   _vehicleWasFlying:      false
Gus Grubba's avatar
Gus Grubba committed
133
    property bool   _rcRSSIAvailable:       activeVehicle ? activeVehicle.rcRSSI > 0 && activeVehicle.rcRSSI <= 100 : false
134

135
    // You can turn on log output for GuidedActionsController by turning on GuidedActionsControllerLog category
Gus Grubba's avatar
Gus Grubba committed
136 137
    property bool __guidedModeSupported:    activeVehicle ? activeVehicle.guidedModeSupported : false
    property bool __pauseVehicleSupported:  activeVehicle ? activeVehicle.pauseVehicleSupported : false
138
    property bool __flightMode:             _flightMode
139 140

    function _outputState() {
141
        if (_corePlugin.guidedActionsControllerLogging()) {
Gus Grubba's avatar
Gus Grubba committed
142 143 144 145 146 147 148 149
            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))
        }
    }

    Connections {
        target: mainWindow
        onActiveVehicleChanged: {
            _outputState()
150
        }
151 152
    }

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

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

198
    on_VehicleFlyingChanged: {
199
        _outputState()
200 201 202 203 204 205
        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
206 207

    property var _actionData
208 209

    on_FlightModeChanged: {
Gus Grubba's avatar
Gus Grubba committed
210
        _vehiclePaused =        activeVehicle ? _flightMode === activeVehicle.pauseFlightMode : false
211
        _vehicleInRTLMode =     activeVehicle ? _flightMode === activeVehicle.rtlFlightMode || _flightMode === activeVehicle.smartRTLFlightMode : false
Gus Grubba's avatar
Gus Grubba committed
212 213
        _vehicleInLandMode =    activeVehicle ? _flightMode === activeVehicle.landFlightMode : false
        _vehicleInMissionMode = activeVehicle ? _flightMode === activeVehicle.missionFlightMode : false // Must be last to get correct signalling for showStartMission popups
214
    }
215 216

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

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