GuidedActionsController.qml 21.6 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 43 44 45 46 47 48 49 50 51
    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")
    readonly property string continueMissionTitle:          qsTr("Continue Mission")
    readonly property string resumeMissionTitle:            qsTr("Resume Mission")
    readonly property string resumeMissionUploadFailTitle:  qsTr("Resume FAILED")
    readonly property string pauseTitle:                    qsTr("Pause")
    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")
52
    readonly property string vtolTransitionTitle:           qsTr("VTOL Transition")
53

54 55
    readonly property string armMessage:                        qsTr("Arm the vehicle.")
    readonly property string disarmMessage:                     qsTr("Disarm the vehicle")
56
    readonly property string emergencyStopMessage:              qsTr("WARNING: THIS WILL STOP ALL MOTORS. IF VEHICLE IS CURRENTLY IN THE AIR IT WILL CRASH.")
57 58 59 60 61 62 63 64 65
    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.")
             property string resumeMissionMessage:              qsTr("Resume the current mission. This will re-generate the mission from waypoint %1, takeoff and continue the mission.").arg(_resumeMissionIndex)
             property string resumeMissionUploadFailMessage:    qsTr("Upload of resume mission failed. Confirm to retry upload")
    readonly property string resumeMissionReadyMessage:         qsTr("Review the modified mission. Confirm if you want to takeoff and begin mission.")
    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
66
    readonly property string gotoMessage:                       qsTr("Move the vehicle to the specified location.")
67
             property string setWaypointMessage:                qsTr("Adjust current waypoint to %1.").arg(_actionData)
Don Gagne's avatar
Don Gagne committed
68
    readonly property string orbitMessage:                      qsTr("Orbit the vehicle around the specified location.")
69
    readonly property string landAbortMessage:                  qsTr("Abort the landing sequence.")
70
    readonly property string pauseMessage:                      qsTr("Pause the vehicle at it's current position, adjusting altitude up or down as needed.")
71
    readonly property string mvPauseMessage:                    qsTr("Pause all vehicles at their current position.")
72 73
    readonly property string vtolTransitionFwdMessage:          qsTr("Transition VTOL to fixed wing flight.")
    readonly property string vtolTransitionMRMessage:           qsTr("Transition VTOL to multi-rotor flight.")
74

75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91
    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
    readonly property int actionResumeMissionReady:         15
    readonly property int actionResumeMissionUploadFail:    16
    readonly property int actionPause:                      17
92 93
    readonly property int actionMVPause:                    18
    readonly property int actionMVStartMission:             19
94 95
    readonly property int actionVtolTransitionToFwdFlight:  20
    readonly property int actionVtolTransitionToMRFlight:   21
96

97 98 99 100 101 102 103
    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
104
    property bool showContinueMission:  _guidedActionsEnabled && _missionAvailable && !_missionActive && _vehicleArmed && _vehicleFlying && (_currentMissionIndex < missionController.visualItems.count - 1)
105 106
    property bool showPause:            _guidedActionsEnabled && _vehicleArmed && _activeVehicle.pauseVehicleSupported && _vehicleFlying && !_vehiclePaused
    property bool showChangeAlt:        _guidedActionsEnabled && _vehicleFlying && _activeVehicle.guidedModeSupported && _vehicleArmed && !_missionActive
DonLakeFlyer's avatar
DonLakeFlyer committed
107
    property bool showOrbit:            _guidedActionsEnabled && !_hideOrbit && _vehicleFlying && _activeVehicle.orbitModeSupported && !_missionActive
108 109
    property bool showLandAbort:        _guidedActionsEnabled && _vehicleFlying && _activeVehicle.fixedWing && _vehicleLanding
    property bool showGotoLocation:     _guidedActionsEnabled && _vehicleFlying
110

111 112 113
    // Note: The 'missionController.visualItems.count - 3' 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 < missionController.visualItems.count - 3)

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

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    _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
133
    property bool   _rcRSSIAvailable:       _activeVehicle ? _activeVehicle.rcRSSI > 0 && _activeVehicle.rcRSSI <= 100 : false
134

135
    //Handy code for debugging state problems
136 137
    property bool __debugGuidedStates:      false
    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 144
        if (__debugGuidedStates) {
            console.log(qsTr("_activeVehicle(%1) _vehicleArmed(%2) guidedModeSupported(%3) _vehicleFlying(%4) _vehicleInRTLMode(%5) pauseVehicleSupported(%6) _vehiclePaused(%7) _flightMode(%8)").arg(_activeVehicle ? 1 : 0).arg(_vehicleArmed ? 1 : 0).arg(__guidedModeSupported ? 1 : 0).arg(_vehicleFlying ? 1 : 0).arg(_vehicleInRTLMode ? 1 : 0).arg(__pauseVehicleSupported ? 1 : 0).arg(_vehiclePaused ? 1 : 0).arg(_flightMode))
        }
145 146
    }

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

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

186
    on_VehicleFlyingChanged: {
187
        _outputState()
188 189 190 191 192 193
        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
194 195

    property var _actionData
196 197

    on_FlightModeChanged: {
198 199 200 201
        _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
202
    }
203 204 205

    // Called when an action is about to be executed in order to confirm
    function confirmAction(actionCode, actionData) {
206
        var showImmediate = true
207
        closeAll()
208 209
        confirmDialog.action = actionCode
        confirmDialog.actionData = actionData
210
        confirmDialog.hideTrigger = true
211 212 213
        _actionData = actionData
        switch (actionCode) {
        case actionArm:
214
            if (_vehicleFlying || !_guidedActionsEnabled) {
215 216
                return
            }
217 218 219
            confirmDialog.title = armTitle
            confirmDialog.message = armMessage
            confirmDialog.hideTrigger = Qt.binding(function() { return !showArm })
220 221
            break;
        case actionDisarm:
222
            if (_vehicleFlying) {
223 224
                return
            }
225 226 227
            confirmDialog.title = disarmTitle
            confirmDialog.message = disarmMessage
            confirmDialog.hideTrigger = Qt.binding(function() { return !showDisarm })
228 229
            break;
        case actionEmergencyStop:
230 231 232
            confirmDialog.title = emergencyStopTitle
            confirmDialog.message = emergencyStopMessage
            confirmDialog.hideTrigger = Qt.binding(function() { return !showEmergenyStop })
233 234
            break;
        case actionTakeoff:
235 236 237
            confirmDialog.title = takeoffTitle
            confirmDialog.message = takeoffMessage
            confirmDialog.hideTrigger = Qt.binding(function() { return !showTakeoff })
238
            altitudeSlider.setToMinimumTakeoff()
239
            altitudeSlider.visible = true
240 241
            break;
        case actionStartMission:
242
            showImmediate = false
243 244 245
            confirmDialog.title = startMissionTitle
            confirmDialog.message = startMissionMessage
            confirmDialog.hideTrigger = Qt.binding(function() { return !showStartMission })
246
            break;
247 248 249 250 251
        case actionMVStartMission:
            confirmDialog.title = startMissionTitle
            confirmDialog.message = startMissionMessage
            confirmDialog.hideTrigger = true
            break;
252
        case actionContinueMission:
253
            showImmediate = false
254 255 256 257
            confirmDialog.title = continueMissionTitle
            confirmDialog.message = continueMissionMessage
            confirmDialog.hideTrigger = Qt.binding(function() { return !showContinueMission })
            break;
258
        case actionResumeMission:
259
            showImmediate = false
260 261 262
            confirmDialog.title = resumeMissionTitle
            confirmDialog.message = resumeMissionMessage
            confirmDialog.hideTrigger = Qt.binding(function() { return !showResumeMission })
263
            break;
264 265 266 267 268
        case actionResumeMissionUploadFail:
            confirmDialog.title = resumeMissionUploadFailTitle
            confirmDialog.message = resumeMissionUploadFailMessage
            confirmDialog.hideTrigger = Qt.binding(function() { return !showResumeMission })
            break;
269
        case actionResumeMissionReady:
270 271 272
            confirmDialog.title = resumeMissionTitle
            confirmDialog.message = resumeMissionReadyMessage
            confirmDialog.hideTrigger = false
273 274
            break;
        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 320 321 322 323
        case actionMVPause:
            confirmDialog.title = pauseTitle
            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 actionResumeMissionReady:
360
            _vehicleWasFlying = false
361 362 363
            _activeVehicle.startMission()
            break
        case actionStartMission:
364
        case actionContinueMission:
365 366
            _activeVehicle.startMission()
            break
367
        case actionMVStartMission:
368 369 370
            rgVehicle = QGroundControl.multiVehicleManager.vehicles
            for (i = 0; i < rgVehicle.count; i++) {
                rgVehicle.get(i).startMission()
371 372
            }
            break
373
        case actionArm:
DonLakeFlyer's avatar
DonLakeFlyer committed
374
            _activeVehicle.armed = true
375 376
            break
        case actionDisarm:
DonLakeFlyer's avatar
DonLakeFlyer committed
377
            _activeVehicle.armed = false
378 379 380 381 382
            break
        case actionEmergencyStop:
            _activeVehicle.emergencyStop()
            break
        case actionChangeAlt:
DonLakeFlyer's avatar
DonLakeFlyer committed
383
            _activeVehicle.guidedModeChangeAltitude(actionAltitudeChange)
384 385 386 387 388 389 390 391
            break
        case actionGoto:
            _activeVehicle.guidedModeGotoLocation(actionData)
            break
        case actionSetWaypoint:
            _activeVehicle.setCurrentMissionSequence(actionData)
            break
        case actionOrbit:
DonLakeFlyer's avatar
DonLakeFlyer committed
392
            _activeVehicle.guidedModeOrbit(orbitMapCircle.center, orbitMapCircle.radius(), _activeVehicle.altitudeAMSL.rawValue + actionAltitudeChange)
393
            orbitMapCircle.hide()
394 395 396 397 398 399
            break
        case actionLandAbort:
            _activeVehicle.abortLanding(50)     // hardcoded value for climbOutAltitude that is currently ignored
            break
        case actionPause:
            _activeVehicle.pauseVehicle()
DonLakeFlyer's avatar
DonLakeFlyer committed
400
            _activeVehicle.guidedModeChangeAltitude(actionAltitudeChange)
401
            break
402
        case actionMVPause:
403 404 405
            rgVehicle = QGroundControl.multiVehicleManager.vehicles
            for (i = 0; i < rgVehicle.count; i++) {
                rgVehicle.get(i).pauseVehicle()
406 407
            }
            break
408 409 410 411 412 413
        case actionVtolTransitionToFwdFlight:
            _activeVehicle.vtolInFwdFlight = true
            break
        case actionVtolTransitionToMRFlight:
            _activeVehicle.vtolInFwdFlight = false
            break
414 415 416 417 418 419
        default:
            console.warn(qsTr("Internal error: unknown actionCode"), actionCode)
            break
        }
    }
}