GuidedActionsController.qml 21.5 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 99 100 101 102
    property bool showEmergenyStop:     _guidedActionsEnabled && !_hideEmergenyStop && _vehicleArmed && _vehicleFlying
    property bool showArm:              _guidedActionsEnabled && !_vehicleArmed
    property bool showDisarm:           _guidedActionsEnabled && _vehicleArmed && !_vehicleFlying
    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
    property bool showStartMission:     _guidedActionsEnabled && _missionAvailable && !_missionActive && !_vehicleFlying
103
    property bool showContinueMission:  _guidedActionsEnabled && _missionAvailable && !_missionActive && _vehicleArmed && _vehicleFlying && (_currentMissionIndex < _missionItemCount - 1)
104 105
    property bool showPause:            _guidedActionsEnabled && _vehicleArmed && _activeVehicle.pauseVehicleSupported && _vehicleFlying && !_vehiclePaused
    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 108
    property bool showLandAbort:        _guidedActionsEnabled && _vehicleFlying && _activeVehicle.fixedWing && _vehicleLanding
    property bool showGotoLocation:     _guidedActionsEnabled && _vehicleFlying
109

110 111
    // Note: The '_missionItemCount - 2' is a hack to not trigger resume mission when a mission ends with an RTL item
    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
116
    property bool   _guidedActionsEnabled:  (!ScreenTools.isDebug && QGroundControl.corePlugin.options.guidedActionsRequireRCRSSI && _activeVehicle) ? _rcRSSIAvailable : _activeVehicle
117 118 119 120 121
    property var    _activeVehicle:         QGroundControl.multiVehicleManager.activeVehicle
    property string _flightMode:            _activeVehicle ? _activeVehicle.flightMode : ""
    property bool   _missionAvailable:      missionController.containsItems
    property bool   _missionActive:         _activeVehicle ? _vehicleArmed && (_vehicleInLandMode || _vehicleInRTLMode || _vehicleInMissionMode) : false
    property bool   _vehicleArmed:          _activeVehicle ? _activeVehicle.armed  : false
122
    property bool   _vehicleFlying:         _activeVehicle ? _activeVehicle.flying  : false
123
    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

136
    // You can turn on log output for GuidedActionsController by turning on GuidedActionsControllerLog category
137
    property bool __guidedModeSupported:    _activeVehicle ? _activeVehicle.guidedModeSupported : false
138
    property bool __pauseVehicleSupported:  _activeVehicle ? _activeVehicle.pauseVehicleSupported : false
139
    property bool __flightMode:             _flightMode
140 141

    function _outputState() {
142 143
        if (_corePlugin.guidedActionsControllerLogging()) {
            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))
144
        }
145 146
    }

147 148 149 150 151 152 153 154
    Component.onCompleted:              _outputState()
    on_ActiveVehicleChanged:            _outputState()
    on_VehicleArmedChanged:             _outputState()
    on_VehicleInRTLModeChanged:         _outputState()
    on_VehiclePausedChanged:            _outputState()
    on__FlightModeChanged:              _outputState()
    on__GuidedModeSupportedChanged:     _outputState()
    on__PauseVehicleSupportedChanged:   _outputState()
155
    on_MissionItemCountChanged:         _outputState()
156

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

193
    on_VehicleFlyingChanged: {
194
        _outputState()
195 196 197 198 199 200
        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
201 202

    property var _actionData
203 204

    on_FlightModeChanged: {
205 206 207 208
        _vehiclePaused =        _activeVehicle ? _flightMode === _activeVehicle.pauseFlightMode : false
        _vehicleInRTLMode =     _activeVehicle ? _flightMode === _activeVehicle.rtlFlightMode : false
        _vehicleInLandMode =    _activeVehicle ? _flightMode === _activeVehicle.landFlightMode : false
        _vehicleInMissionMode = _activeVehicle ? _flightMode === _activeVehicle.missionFlightMode : false // Must be last to get correct signalling for showStartMission popups
209
    }
210 211

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

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