APMTuningComponentCopter.qml 23.1 KB
Newer Older
1 2
/****************************************************************************
 *
Gus Grubba's avatar
Gus Grubba committed
3
 * (c) 2009-2020 QGROUNDCONTROL PROJECT <http://www.qgroundcontrol.org>
4 5 6 7 8
 *
 * QGroundControl is licensed according to the terms in the file
 * COPYING.md in the root of the source code directory.
 *
 ****************************************************************************/
Don Gagne's avatar
Don Gagne committed
9 10


11 12
import QtQuick              2.3
import QtQuick.Controls     1.2
13
import QtQuick.Layouts      1.2
Don Gagne's avatar
Don Gagne committed
14 15 16 17 18 19 20

import QGroundControl.FactSystem    1.0
import QGroundControl.FactControls  1.0
import QGroundControl.Palette       1.0
import QGroundControl.Controls      1.0
import QGroundControl.ScreenTools   1.0

21 22 23 24 25 26 27 28
SetupPage {
    id:             tuningPage
    pageComponent:  tuningPageComponent

    Component {
        id: tuningPageComponent

        Column {
29
            width: availableWidth
30

31
            FactPanelController { id: controller; }
32

33 34
            property bool _atcInputTCAvailable: controller.parameterExists(-1, "ATC_INPUT_TC")
            property Fact _atcInputTC:          controller.getParameterFact(-1, "ATC_INPUT_TC", false)
35 36 37 38 39 40 41 42
            property Fact _rateRollP:           controller.getParameterFact(-1, "ATC_RAT_RLL_P")
            property Fact _rateRollI:           controller.getParameterFact(-1, "ATC_RAT_RLL_I")
            property Fact _ratePitchP:          controller.getParameterFact(-1, "ATC_RAT_PIT_P")
            property Fact _ratePitchI:          controller.getParameterFact(-1, "ATC_RAT_PIT_I")
            property Fact _rateClimbP:          controller.getParameterFact(-1, "PSC_ACCZ_P")
            property Fact _rateClimbI:          controller.getParameterFact(-1, "PSC_ACCZ_I")
            property Fact _motSpinArm:          controller.getParameterFact(-1, "MOT_SPIN_ARM")
            property Fact _motSpinMin:          controller.getParameterFact(-1, "MOT_SPIN_MIN")
43

44 45 46 47 48 49
            property Fact _ch7Opt:  controller.getParameterFact(-1, "r.RC7_OPTION")
            property Fact _ch8Opt:  controller.getParameterFact(-1, "r.RC8_OPTION")
            property Fact _ch9Opt:  controller.getParameterFact(-1, "r.RC9_OPTION")
            property Fact _ch10Opt: controller.getParameterFact(-1, "r.RC10_OPTION")
            property Fact _ch11Opt: controller.getParameterFact(-1, "r.RC11_OPTION")
            property Fact _ch12Opt: controller.getParameterFact(-1, "r.RC12_OPTION")
50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66

            readonly property int   _firstOptionChannel:    7
            readonly property int   _lastOptionChannel:     12

            property Fact   _autoTuneAxes:                  controller.getParameterFact(-1, "AUTOTUNE_AXES")
            property int    _autoTuneSwitchChannelIndex:    0
            readonly property int _autoTuneOption:          17

            property real _margins: ScreenTools.defaultFontPixelHeight

            property bool _loadComplete: false

            ExclusiveGroup { id: fenceActionRadioGroup }
            ExclusiveGroup { id: landLoiterRadioGroup }
            ExclusiveGroup { id: returnAltRadioGroup }

            Component.onCompleted: {
67 68
                // We use QtCharts only on Desktop platforms
                showAdvanced = !ScreenTools.isMobile
69

70 71 72 73 74 75 76
                // Qml Sliders have a strange behavior in which they first set Slider::value to some internal
                // setting and then set Slider::value to the bound properties value. If you have an onValueChanged
                // handler which updates your property with the new value, this first value change will trash
                // your bound values. In order to work around this we don't set the values into the Sliders until
                // after Qml load is done. We also don't track value changes until Qml load completes.
                rollPitch.value = _rateRollP.value
                climb.value = _rateClimbP.value
77 78 79
                if (_atcInputTCAvailable) {
                    atcInputTC.value = _atcInputTC.value
                }
80 81 82
                _loadComplete = true

                calcAutoTuneChannel()
Don Gagne's avatar
Don Gagne committed
83
            }
84

85
            /// The AutoTune switch is stored in one of the RC#_OPTION parameters. We need to loop through those
86 87 88 89
            /// to find them and setup the ui accordindly.
            function calcAutoTuneChannel() {
                _autoTuneSwitchChannelIndex = 0
                for (var channel=_firstOptionChannel; channel<=_lastOptionChannel; channel++) {
90
                    var optionFact = controller.getParameterFact(-1, "r.RC" + channel + "_OPTION")
91 92 93 94 95
                    if (optionFact.value == _autoTuneOption) {
                        _autoTuneSwitchChannelIndex = channel - _firstOptionChannel + 1
                        break
                    }
                }
Don Gagne's avatar
Don Gagne committed
96
            }
97 98 99 100 101

            /// We need to clear AutoTune from any previous channel before setting it to a new one
            function setChannelAutoTuneOption(channel) {
                // First clear any previous settings for AutTune
                for (var optionChannel=_firstOptionChannel; optionChannel<=_lastOptionChannel; optionChannel++) {
102
                    var optionFact = controller.getParameterFact(-1, "r.RC" + optionChannel + "_OPTION")
103 104 105 106 107 108 109
                    if (optionFact.value == _autoTuneOption) {
                        optionFact.value = 0
                    }
                }

                // Now set the function into the new channel
                if (channel != 0) {
110
                    var optionFact = controller.getParameterFact(-1, "r.RC" + channel + "_OPTION")
111 112 113 114 115 116 117 118 119 120
                    optionFact.value = _autoTuneOption
                }
            }

            Connections { target: _ch7Opt; onValueChanged: calcAutoTuneChannel() }
            Connections { target: _ch8Opt; onValueChanged: calcAutoTuneChannel() }
            Connections { target: _ch9Opt; onValueChanged: calcAutoTuneChannel() }
            Connections { target: _ch10Opt; onValueChanged: calcAutoTuneChannel() }
            Connections { target: _ch11Opt; onValueChanged: calcAutoTuneChannel() }
            Connections { target: _ch12Opt; onValueChanged: calcAutoTuneChannel() }
Don Gagne's avatar
Don Gagne committed
121

122
            Column {
Don Gagne's avatar
Don Gagne committed
123 124
                anchors.left:       parent.left
                anchors.right:      parent.right
125 126
                spacing:            _margins
                visible:            !advanced
Don Gagne's avatar
Don Gagne committed
127

128 129 130 131
                QGCLabel {
                    text:       qsTr("Basic Tuning")
                    font.family: ScreenTools.demiboldFontFamily
                }
Don Gagne's avatar
Don Gagne committed
132

133 134
                Rectangle {
                    id:                 basicTuningRect
Don Gagne's avatar
Don Gagne committed
135 136
                    anchors.left:       parent.left
                    anchors.right:      parent.right
137
                    height:             basicTuningColumn.y + basicTuningColumn.height + _margins
138
                    color:              qgcPal.windowShade
Don Gagne's avatar
Don Gagne committed
139 140

                    Column {
141 142 143 144 145 146
                        id:                 basicTuningColumn
                        anchors.margins:    _margins
                        anchors.left:       parent.left
                        anchors.right:      parent.right
                        anchors.top:        parent.top
                        spacing:            _margins
Don Gagne's avatar
Don Gagne committed
147

148
                        Column {
Don Gagne's avatar
Don Gagne committed
149 150 151
                            anchors.left:       parent.left
                            anchors.right:      parent.right

152 153 154 155
                            QGCLabel {
                                text:       qsTr("Roll/Pitch Sensitivity")
                                font.family: ScreenTools.demiboldFontFamily
                            }
Don Gagne's avatar
Don Gagne committed
156

157 158 159
                            QGCLabel {
                                text: qsTr("Slide to the right if the copter is sluggish or slide to the left if the copter is twitchy")
                            }
Don Gagne's avatar
Don Gagne committed
160

161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176
                            Slider {
                                id:                 rollPitch
                                anchors.left:       parent.left
                                anchors.right:      parent.right
                                minimumValue:       0.08
                                maximumValue:       0.4
                                stepSize:           0.01
                                tickmarksEnabled:   true

                                onValueChanged: {
                                    if (_loadComplete) {
                                        _rateRollP.value = value
                                        _rateRollI.value = value
                                        _ratePitchP.value = value
                                        _ratePitchI.value = value
                                    }
Don Gagne's avatar
Don Gagne committed
177 178 179 180
                                }
                            }
                        }

181
                        Column {
Don Gagne's avatar
Don Gagne committed
182 183 184
                            anchors.left:       parent.left
                            anchors.right:      parent.right

185 186 187 188
                            QGCLabel {
                                text:       qsTr("Climb Sensitivity")
                                font.family: ScreenTools.demiboldFontFamily
                            }
Don Gagne's avatar
Don Gagne committed
189

190 191 192
                            QGCLabel {
                                text: qsTr("Slide to the right to climb more aggressively or slide to the left to climb more gently")
                            }
Don Gagne's avatar
Don Gagne committed
193

194 195 196 197 198 199 200 201 202 203 204 205 206 207 208
                            Slider {
                                id:                 climb
                                anchors.left:       parent.left
                                anchors.right:      parent.right
                                minimumValue:       0.3
                                maximumValue:       1.0
                                stepSize:           0.02
                                tickmarksEnabled:   true
                                value:              _rateClimbP.value

                                onValueChanged: {
                                    if (_loadComplete) {
                                        _rateClimbP.value = value
                                        _rateClimbI.value = value * 2
                                    }
Don Gagne's avatar
Don Gagne committed
209 210 211 212
                                }
                            }
                        }

213
                        Column {
Don Gagne's avatar
Don Gagne committed
214 215
                            anchors.left:       parent.left
                            anchors.right:      parent.right
216
                            visible:            _atcInputTCAvailable
217

218 219 220 221
                            QGCLabel {
                                text:       qsTr("RC Roll/Pitch Feel")
                                font.family: ScreenTools.demiboldFontFamily
                            }
222

223 224 225
                            QGCLabel {
                                text: qsTr("Slide to the left for soft control, slide to the right for crisp control")
                            }
226

227 228 229 230 231 232 233 234 235 236 237 238 239
                            Slider {
                                id:                 atcInputTC
                                anchors.left:       parent.left
                                anchors.right:      parent.right
                                minimumValue:       _atcInputTC.min
                                maximumValue:       _atcInputTC.max
                                stepSize:           _atcInputTC.increment
                                tickmarksEnabled:   true

                                onValueChanged: {
                                    if (_loadComplete) {
                                        _atcInputTC.value = value
                                    }
Don Gagne's avatar
Don Gagne committed
240 241 242
                                }
                            }
                        }
243

244 245 246
                        Column {
                            anchors.left:       parent.left
                            anchors.right:      parent.right
247

248 249 250 251
                            QGCLabel {
                                text:       qsTr("Spin While Armed")
                                font.family: ScreenTools.demiboldFontFamily
                            }
252

253 254 255
                            QGCLabel {
                                text: qsTr("Adjust the amount the motors spin to indicate armed")
                            }
256

257 258 259 260 261 262 263 264 265 266 267 268 269
                            Slider {
                                anchors.left:       parent.left
                                anchors.right:      parent.right
                                minimumValue:       0
                                maximumValue:       Math.max(0.3, _motSpinArm.rawValue)
                                stepSize:           0.01
                                tickmarksEnabled:   true
                                value:              _motSpinArm.rawValue

                                onValueChanged: {
                                    if (_loadComplete) {
                                        _motSpinArm.rawValue = value
                                    }
270 271
                                }
                            }
272 273
                        }

274
                        Column {
275 276
                            anchors.left:       parent.left
                            anchors.right:      parent.right
277

278 279 280 281
                            QGCLabel {
                                text:       qsTr("Minimum Thrust")
                                font.family: ScreenTools.demiboldFontFamily
                            }
282

283 284 285
                            QGCLabel {
                                text: qsTr("Adjust the minimum amount of thrust require for the vehicle to move")
                            }
286

287 288
                            QGCLabel {
                                text:       qsTr("Warning: This setting should be higher than 'Spin While Armed'")
289
                                color:      qgcPal.warningText
290 291
                                visible:    _motSpinMin.rawValue < _motSpinArm.rawValue
                            }
292

293 294 295 296 297 298 299 300 301 302 303 304 305
                            Slider {
                                anchors.left:       parent.left
                                anchors.right:      parent.right
                                minimumValue:       0
                                maximumValue:       Math.max(0.3, _motSpinMin.rawValue)
                                stepSize:           0.01
                                tickmarksEnabled:   true
                                value:              _motSpinMin.rawValue

                                onValueChanged: {
                                    if (_loadComplete) {
                                        _motSpinMin.rawValue = value
                                    }
306 307 308 309
                                }
                            }
                        }
                    }
310
                } // Rectangle - Basic tuning
Don Gagne's avatar
Don Gagne committed
311

312 313 314 315
                Flow {
                    id:                 flowLayout
                    Layout.fillWidth:   true
                    spacing:            _margins
Don Gagne's avatar
Don Gagne committed
316

317
                    Rectangle {
318 319
                        height: autoTuneLabel.height + autoTuneRect.height
                        width:  autoTuneRect.width
320
                        color:  qgcPal.window
Don Gagne's avatar
Don Gagne committed
321

322 323 324 325 326
                        QGCLabel {
                            id:                 autoTuneLabel
                            text:               qsTr("AutoTune")
                            font.family:        ScreenTools.demiboldFontFamily
                        }
Don Gagne's avatar
Don Gagne committed
327

328 329 330 331 332
                        Rectangle {
                            id:             autoTuneRect
                            width:          autoTuneColumn.x + autoTuneColumn.width + _margins
                            height:         autoTuneColumn.y + autoTuneColumn.height + _margins
                            anchors.top:    autoTuneLabel.bottom
333
                            color:          qgcPal.windowShade
334 335 336 337 338 339 340 341 342 343 344 345 346 347

                            Column {
                                id:                 autoTuneColumn
                                anchors.margins:    _margins
                                anchors.left:       parent.left
                                anchors.top:        parent.top
                                spacing:            _margins

                                Row {
                                    spacing: _margins

                                    QGCLabel { text: qsTr("Axes to AutoTune:") }
                                    FactBitmask { fact: _autoTuneAxes }
                                }
348

349 350
                                Row {
                                    spacing:    _margins
351

352 353 354 355
                                    QGCLabel {
                                        anchors.baseline:   autoTuneChannelCombo.baseline
                                        text:               qsTr("Channel for AutoTune switch:")
                                    }
Don Gagne's avatar
Don Gagne committed
356

357 358 359 360 361
                                    QGCComboBox {
                                        id:             autoTuneChannelCombo
                                        width:          ScreenTools.defaultFontPixelWidth * 14
                                        model:          [qsTr("None"), qsTr("Channel 7"), qsTr("Channel 8"), qsTr("Channel 9"), qsTr("Channel 10"), qsTr("Channel 11"), qsTr("Channel 12") ]
                                        currentIndex:   _autoTuneSwitchChannelIndex
Don Gagne's avatar
Don Gagne committed
362

363 364
                                        onActivated: {
                                            var channel = index
Don Gagne's avatar
Don Gagne committed
365

366 367 368 369
                                            if (channel > 0) {
                                                channel += 6
                                            }
                                            setChannelAutoTuneOption(channel)
370 371
                                        }
                                    }
Don Gagne's avatar
Don Gagne committed
372 373
                                }
                            }
374 375
                        } // Rectangle - AutoTune
                    } // Rectangle - AutoTuneWrap
376 377

                    Rectangle {
378 379
                        height:     inFlightTuneLabel.height + channel6TuningOption.height
                        width:      channel6TuningOption.width
380
                        color:      qgcPal.window
381

382 383 384 385 386
                        QGCLabel {
                            id:                 inFlightTuneLabel
                            text:               qsTr("In Flight Tuning")
                            font.family:        ScreenTools.demiboldFontFamily
                        }
387

388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407 408 409 410
                        Rectangle {
                            id:             channel6TuningOption
                            width:          channel6TuningOptColumn.width + (_margins * 2)
                            height:         channel6TuningOptColumn.height + ScreenTools.defaultFontPixelHeight
                            anchors.top:    inFlightTuneLabel.bottom
                            color:          qgcPal.windowShade

                            Column {
                                id:                 channel6TuningOptColumn
                                anchors.margins:    ScreenTools.defaultFontPixelWidth
                                anchors.left:       parent.left
                                anchors.top:        parent.top
                                spacing:            ScreenTools.defaultFontPixelHeight

                                Row {
                                    spacing: ScreenTools.defaultFontPixelWidth
                                    property Fact nullFact: Fact { }

                                    QGCLabel {
                                        anchors.baseline:   optCombo.baseline
                                        text:               qsTr("RC Channel 6 Option (Tuning):")
                                        //color:            controller.channelOptionEnabled[modelData] ? "yellow" : qgcPal.text
                                    }
411

412 413 414 415 416 417
                                    FactComboBox {
                                        id:         optCombo
                                        width:      ScreenTools.defaultFontPixelWidth * 15
                                        fact:       controller.getParameterFact(-1, "TUNE")
                                        indexModel: false
                                    }
418 419
                                }

420 421 422
                                Row {
                                    spacing: ScreenTools.defaultFontPixelWidth
                                    property Fact nullFact: Fact { }
423

424 425 426 427 428
                                    QGCLabel {
                                        anchors.baseline:   tuneMinField.baseline
                                        text:               qsTr("Min:")
                                        //color:            controller.channelOptionEnabled[modelData] ? "yellow" : qgcPal.text
                                    }
429

430 431 432
                                    FactTextField {
                                        id:                 tuneMinField
                                        validator:          DoubleValidator {bottom: 0; top: 32767;}
DonLakeFlyer's avatar
DonLakeFlyer committed
433
                                        fact:               controller.getParameterFact(-1, "r.TUNE_MAX")
434
                                    }
435

436 437 438 439 440
                                    QGCLabel {
                                        anchors.baseline:   tuneMaxField.baseline
                                        text:               qsTr("Max:")
                                        //color:            controller.channelOptionEnabled[modelData] ? "yellow" : qgcPal.text
                                    }
441

442 443 444
                                    FactTextField {
                                        id:                 tuneMaxField
                                        validator:          DoubleValidator {bottom: 0; top: 32767;}
DonLakeFlyer's avatar
DonLakeFlyer committed
445
                                        fact:               controller.getParameterFact(-1, "r.TUNE_MIN")
446
                                    }
447
                                }
448 449 450 451 452
                            } // Column - Channel 6 Tuning option
                        } // Rectangle - Channel 6 Tuning options
                    } // Rectangle - Channel 6 Tuning options wrap
                } // Flow - Tune
            }
453

454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480
            Loader {
                anchors.left:       parent.left
                anchors.right:      parent.right
                sourceComponent:    advanced ? advancePageComponent : undefined
            }

            Component {
                id: advancePageComponent

                PIDTuning {
                    anchors.left:   parent.left
                    anchors.right:  parent.right
                    tuneList:            [ qsTr("Roll"), qsTr("Pitch"), qsTr("Yaw") ]
                    params:              [
                        [ controller.getParameterFact(-1, "ATC_ANG_RLL_P"),
                         controller.getParameterFact(-1, "ATC_RAT_RLL_P"),
                         controller.getParameterFact(-1, "ATC_RAT_RLL_I"),
                         controller.getParameterFact(-1, "ATC_RAT_RLL_D") ],
                        [ controller.getParameterFact(-1, "ATC_ANG_PIT_P"),
                         controller.getParameterFact(-1, "ATC_RAT_PIT_P"),
                         controller.getParameterFact(-1, "ATC_RAT_PIT_I"),
                         controller.getParameterFact(-1, "ATC_RAT_PIT_D") ],
                        [ controller.getParameterFact(-1, "ATC_ANG_YAW_P"),
                         controller.getParameterFact(-1, "ATC_RAT_YAW_P"),
                         controller.getParameterFact(-1, "ATC_RAT_YAW_I") ] ]
                }
            } // Component - Advanced Page
481 482 483
        } // Column
    } // Component
} // SetupView