SensorsComponent.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
/*=====================================================================

 QGroundControl Open Source Ground Control Station

 (c) 2009 - 2015 QGROUNDCONTROL PROJECT <http://www.qgroundcontrol.org>

 This file is part of the QGROUNDCONTROL project

 QGROUNDCONTROL is free software: you can redistribute it and/or modify
 it under the terms of the GNU General Public License as published by
 the Free Software Foundation, either version 3 of the License, or
 (at your option) any later version.

 QGROUNDCONTROL is distributed in the hope that it will be useful,
 but WITHOUT ANY WARRANTY; without even the implied warranty of
 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 GNU General Public License for more details.

 You should have received a copy of the GNU General Public License
 along with QGROUNDCONTROL. If not, see <http://www.gnu.org/licenses/>.

 ======================================================================*/

Don Gagne's avatar
Don Gagne committed
24 25 26
import QtQuick 2.2
import QtQuick.Controls 1.2
import QtQuick.Controls.Styles 1.2
Don Gagne's avatar
Don Gagne committed
27
import QtQuick.Dialogs 1.2
Don Gagne's avatar
Don Gagne committed
28 29 30 31 32

import QGroundControl.FactSystem 1.0
import QGroundControl.FactControls 1.0
import QGroundControl.Palette 1.0
import QGroundControl.Controls 1.0
33
import QGroundControl.ScreenTools 1.0
Don Gagne's avatar
Don Gagne committed
34 35 36

Rectangle {
    property QGCPalette qgcPal: QGCPalette { colorGroupEnabled: true }
37
    property ScreenTools screenTools: ScreenTools { }
Don Gagne's avatar
Don Gagne committed
38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69

    readonly property int rotationColumnWidth: 200
    readonly property var rotations: [
        "ROTATION_NONE",
        "ROTATION_YAW_45",
        "ROTATION_YAW_90",
        "ROTATION_YAW_135",
        "ROTATION_YAW_180",
        "ROTATION_YAW_225",
        "ROTATION_YAW_270",
        "ROTATION_YAW_315",
        "ROTATION_ROLL_180",
        "ROTATION_ROLL_180_YAW_45",
        "ROTATION_ROLL_180_YAW_90",
        "ROTATION_ROLL_180_YAW_135",
        "ROTATION_PITCH_180",
        "ROTATION_ROLL_180_YAW_225",
        "ROTATION_ROLL_180_YAW_270",
        "ROTATION_ROLL_180_YAW_315",
        "ROTATION_ROLL_90",
        "ROTATION_ROLL_90_YAW_45",
        "ROTATION_ROLL_90_YAW_90",
        "ROTATION_ROLL_90_YAW_135",
        "ROTATION_ROLL_270",
        "ROTATION_ROLL_270_YAW_45",
        "ROTATION_ROLL_270_YAW_90",
        "ROTATION_ROLL_270_YAW_135",
        "ROTATION_PITCH_90",
        "ROTATION_PITCH_270",
        "ROTATION_ROLL_270_YAW_270"
    ]

Don Gagne's avatar
Don Gagne committed
70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88
    readonly property string statusTextAreaDefaultText: "Sensor config is a work in progress. Not all visuals for all calibration types fully implemented.\n\n" +
                                                            "For Compass calibration you will need to rotate your vehicle through a number of positions. For this calibration is is best " +
                                                            "to be connected to you vehicle via radio instead of USB since the USB cable will likely get in the way.\n\n" +
                                                            "For Gyroscope calibration you will need to place your vehicle right side up on solid surface and leave it still.\n\n" +
                                                            "For Accelerometer calibration you will need to place your vehicle on all six sides and hold it there for a few seconds.\n\n" +
                                                            "For Airspeed calibration you will need to keep your airspeed sensor out of any wind.\n\n"

    Fact { id: cal_mag0_id; name: "CAL_MAG0_ID" }
    Fact { id: cal_mag1_id; name: "CAL_MAG1_ID" }
    Fact { id: cal_mag2_id; name: "CAL_MAG2_ID" }
    Fact { id: cal_mag0_rot; name: "CAL_MAG0_ROT" }
    Fact { id: cal_mag1_rot; name: "CAL_MAG1_ROT" }
    Fact { id: cal_mag2_rot; name: "CAL_MAG2_ROT" }

    // Id > = signals compass available, rot < 0 signals internal compass
    property bool showCompass0Rot: cal_mag0_id.value > 0 && cal_mag0_rot.value >= 0
    property bool showCompass1Rot: cal_mag1_id.value > 0 && cal_mag1_rot.value >= 0
    property bool showCompass2Rot: cal_mag2_id.value > 0 && cal_mag2_rot.value >= 0

Don Gagne's avatar
Don Gagne committed
89 90 91 92 93 94 95 96 97 98
    color: qgcPal.window

    // We use this bogus loader just so we can get an onLoaded signal to hook to in order to
    // finish controller initialization.
    Component {
        id: loadSignal;
        Item { }
    }
    Loader {
        sourceComponent: loadSignal
99 100 101
        onLoaded: {
            controller.statusLog = statusTextArea
            controller.progressBar = progressBar
102 103 104 105
            controller.compassButton = compassButton
            controller.gyroButton = gyroButton
            controller.accelButton = accelButton
            controller.airspeedButton = airspeedButton
Don Gagne's avatar
Don Gagne committed
106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326
            controller.cancelButton = cancelButton
            controller.orientationCalAreaHelpText = orientationCalAreaHelpText
        }
    }

    Connections {
        target: controller

        onResetStatusTextArea: statusTextArea.text = statusTextAreaDefaultText
        onSetCompassRotations: showCompassRotationOverlay()
    }

    Rectangle {
        id:             overlay
        anchors.fill:   parent
        color:          qgcPal.window
        opacity:        0.75
        z:              100
        visible:        false
    }

    Rectangle {
        width:                      300
        height:                     100
        anchors.verticalCenter:     parent.verticalCenter
        anchors.horizontalCenter:   parent.horizontalCenter
        color:                      qgcPal.window
        border.width:               1
        border.color:               qgcPal.text
        visible:                    controller.waitingForCancel
        z:                          overlay.z + 1

        onVisibleChanged: {
            overlay.visible = visible
        }

        QGCLabel {
            anchors.fill:           parent
            verticalAlignment:      Text.AlignVCenter
            horizontalAlignment:    Text.AlignHCenter
            text:                   "Waiting for Cancel (may take a few seconds)"
        }
    }

    Rectangle {
        property string calibrationType

        id:                         boardRotationOverlay
        width:                      300
        height:                     boardRotationOverlayColumn.height + 11
        anchors.verticalCenter:     parent.verticalCenter
        anchors.horizontalCenter:   parent.horizontalCenter
        color:                      qgcPal.window
        border.width:               1
        border.color:               qgcPal.text
        visible:                    false
        z:                          overlay.z + 1

        Column {
            id:                 boardRotationOverlayColumn
            anchors.topMargin:  10
            anchors.top:        parent.top
            width:              parent.width
            spacing:            10

            Column {
                anchors.leftMargin:     10
                anchors.rightMargin:    10
                anchors.left:           parent.left
                anchors.right:          parent.right
                spacing:                10

                QGCLabel {
                    width:      parent.width
                    wrapMode:   Text.WordWrap
                    text:       "Please check and/or update board rotation before calibrating"
                }

                FactComboBox {
                    width:  rotationColumnWidth
                    model:  rotations
                    fact:   Fact { name: "SENS_BOARD_ROT" }
                }
            }

            QGCButton {
                x:          1
                width:      parent.width - 2
                primary:    true
                text:       "OK"

                onClicked: {
                    boardRotationOverlay.visible = false
                    overlay.visible = false

                    if (boardRotationOverlay.calibrationType == "gyro") {
                        controller.calibrateGyro()
                    } else if (boardRotationOverlay.calibrationType == "accel") {
                        controller.calibrateAccel()
                    } else if (boardRotationOverlay.calibrationType == "compass") {
                        controller.calibrateCompass()
                    }
                }
            }
        }
    }

    function showBoardRotationOverlay(calibrationType) {
        boardRotationOverlay.calibrationType = calibrationType
        boardRotationOverlay.visible = true
        overlay.visible = true
    }

    Rectangle {
        id:                         compassRotationOverlay
        width:                      300
        height:                     compassRotationOverlayColumn.height + 11
        anchors.verticalCenter:     parent.verticalCenter
        anchors.horizontalCenter:   parent.horizontalCenter
        color:                      qgcPal.window
        border.width:               1
        border.color:               qgcPal.text
        visible:                    false
        z:                          overlay.z + 1

        Column {
            id:                 compassRotationOverlayColumn
            anchors.topMargin:  10
            anchors.top:        parent.top
            width:              parent.width
            spacing:            10

            Column {
                anchors.leftMargin:     10
                anchors.rightMargin:    10
                anchors.left:           parent.left
                anchors.right:          parent.right
                spacing:                10

                QGCLabel {
                    width:      parent.width
                    wrapMode:   Text.WordWrap
                    text:       "Please check and/or update compass rotation(s)"
                }

                // Compass 0 rotation
                Component {
                    id: compass0ComponentLabel

                    QGCLabel { text: "Compass Orientation" }
                }
                Component {
                    id: compass0ComponentCombo

                    FactComboBox {
                        id:     compass0RotationCombo
                        width:  rotationColumnWidth
                        model:  rotations
                        fact:   Fact { name: "CAL_MAG0_ROT" }
                    }
                }
                Loader { sourceComponent: showCompass0Rot ? compass0ComponentLabel : null }
                Loader { sourceComponent: showCompass0Rot ? compass0ComponentCombo : null }

                // Compass 1 rotation
                Component {
                    id: compass1ComponentLabel

                    QGCLabel { text: "Compass 1 Orientation" }
                }
                Component {
                    id: compass1ComponentCombo

                    FactComboBox {
                        id:     compass1RotationCombo
                        width:  rotationColumnWidth
                        model:  rotations
                        fact:   Fact { name: "CAL_MAG1_ROT" }
                    }
                }
                Loader { sourceComponent: showCompass1Rot ? compass1ComponentLabel : null }
                Loader { sourceComponent: showCompass1Rot ? compass1ComponentCombo : null }

                // Compass 2 rotation
                Component {
                    id: compass2ComponentLabel

                    QGCLabel { text: "Compass 2 Orientation" }
                }
                Component {
                    id: compass2ComponentCombo

                    FactComboBox {
                        id:     compass1RotationCombo
                        width:  rotationColumnWidth
                        model:  rotations
                        fact:   Fact { name: "CAL_MAG2_ROT" }
                    }
                }
                Loader { sourceComponent: showCompass2Rot ? compass2ComponentLabel : null }
                Loader { sourceComponent: showCompass2Rot ? compass2ComponentCombo : null }
            }

            QGCButton {
                x:          1
                width:      parent.width - 2
                primary:    true
                text:       "OK"

                onClicked: {
                    compassRotationOverlay.visible = false
                    overlay.visible = false
               }
            }
        }
    }

    function showCompassRotationOverlay() {
        if (showCompass0Rot || showCompass1Rot || showCompass2Rot) {
            compassRotationOverlay.visible = true
            overlay.visible = true
327
        }
Don Gagne's avatar
Don Gagne committed
328 329 330 331 332 333 334
    }

    Column {
        anchors.fill: parent

        QGCLabel {
            text: "SENSORS CONFIG"
335
            font.pointSize: screenTools.fontPointFactor * (20);
Don Gagne's avatar
Don Gagne committed
336 337 338 339
        }

        Item { height: 20; width: 10 } // spacer

340 341 342 343 344
        Row {
            readonly property int buttonWidth: 120

            spacing: 20

345
            QGCLabel { text: "Calibrate:"; anchors.baseline: compassButton.baseline }
346 347

            IndicatorButton {
348 349
                property Fact fact: Fact { name: "CAL_MAG0_ID" }

350
                id:             compassButton
351 352
                width:          parent.buttonWidth
                text:           "Compass"
353
                indicatorGreen: fact.value != 0
Don Gagne's avatar
Don Gagne committed
354 355

                onClicked: showBoardRotationOverlay("compass")
356 357 358
            }

            IndicatorButton {
359 360
                property Fact fact: Fact { name: "CAL_GYRO0_ID" }

361
                id:             gyroButton
362 363
                width:          parent.buttonWidth
                text:           "Gyroscope"
364
                indicatorGreen: fact.value != 0
Don Gagne's avatar
Don Gagne committed
365 366

                onClicked: showBoardRotationOverlay("gyro")
367 368 369
            }

            IndicatorButton {
370 371
                property Fact fact: Fact { name: "CAL_ACC0_ID" }

372
                id:             accelButton
373
                width:          parent.buttonWidth
Don Gagne's avatar
Don Gagne committed
374
                text:           "Accelerometer"
375
                indicatorGreen: fact.value != 0
Don Gagne's avatar
Don Gagne committed
376 377

                onClicked: showBoardRotationOverlay("accel")
378 379 380
            }

            IndicatorButton {
381 382
                property Fact fact: Fact { name: "SENS_DPRES_OFF" }

383
                id:             airspeedButton
384 385 386
                width:          parent.buttonWidth
                text:           "Airspeed"
                visible:        controller.fixedWing
387 388
                indicatorGreen: fact.value != 0
                onClicked:      controller.calibrateAirspeed()
389
            }
Don Gagne's avatar
Don Gagne committed
390 391 392 393 394 395 396

            QGCButton {
                id:         cancelButton
                text:       "Cancel"
                enabled:    false
                onClicked:  controller.cancelCalibration()
            }
397 398 399 400 401 402 403 404 405 406 407
        }

        Item { height: 20; width: 10 } // spacer

        ProgressBar {
            id: progressBar
            width: parent.width - rotationColumnWidth
        }

        Item { height: 10; width: 10 } // spacer

Don Gagne's avatar
Don Gagne committed
408 409
        Item {
            readonly property int calibrationAreaHeight: 300
410
            property int calDisplayAreaWidth: parent.width - rotationColumnWidth
Don Gagne's avatar
Don Gagne committed
411 412

            width:  parent.width
413
            height: parent.height - y
Don Gagne's avatar
Don Gagne committed
414 415 416

            TextArea {
                id:             statusTextArea
417
                width:          parent.calDisplayAreaWidth
Don Gagne's avatar
Don Gagne committed
418 419 420
                height:         parent.height
                readOnly:       true
                frameVisible:   false
Don Gagne's avatar
Don Gagne committed
421
                text:           statusTextAreaDefaultText
Don Gagne's avatar
Don Gagne committed
422 423 424 425 426 427 428

                style: TextAreaStyle {
                    textColor: qgcPal.text
                    backgroundColor: qgcPal.windowShade
                }
            }

429
            Rectangle {
Don Gagne's avatar
Don Gagne committed
430
                id:         orientationCalArea
431 432
                width:      parent.calDisplayAreaWidth
                height:     parent.height
Don Gagne's avatar
Don Gagne committed
433
                visible:    controller.showOrientationCalArea
434 435 436
                color:      qgcPal.windowShade

                QGCLabel {
Don Gagne's avatar
Don Gagne committed
437 438 439 440
                    id:             orientationCalAreaHelpText
                    width:          parent.width
                    wrapMode:       Text.WordWrap
                    font.pointSize: screenTools.fontPointFactor * (17);
441 442 443
                }

                Flow {
Don Gagne's avatar
Don Gagne committed
444
                    y:          orientationCalAreaHelpText.height
445
                    width:      parent.width
Don Gagne's avatar
Don Gagne committed
446
                    height:     parent.height - orientationCalAreaHelpText.implicitHeight
447 448 449
                    spacing:    5

                    VehicleRotationCal {
Don Gagne's avatar
Don Gagne committed
450
                        visible:            controller.orientationCalDownSideVisible
Don Gagne's avatar
Don Gagne committed
451 452
                        calValid:           controller.orientationCalDownSideDone
                        calInProgress:      controller.orientationCalDownSideInProgress
Don Gagne's avatar
Don Gagne committed
453 454
                        calInProgressText:  controller.orientationCalDownSideRotate ? "Rotate" : "Hold Still"
                        imageSource:        controller.orientationCalDownSideRotate ? "qrc:///qml/VehicleDownRotate.png" : "qrc:///qml/VehicleDown.png"
455 456
                    }
                    VehicleRotationCal {
Don Gagne's avatar
Don Gagne committed
457
                        visible:            controller.orientationCalUpsideDownSideVisible
Don Gagne's avatar
Don Gagne committed
458 459
                        calValid:           controller.orientationCalUpsideDownSideDone
                        calInProgress:      controller.orientationCalUpsideDownSideInProgress
Don Gagne's avatar
Don Gagne committed
460
                        calInProgressText:  "Hold Still"
Don Gagne's avatar
Don Gagne committed
461
                        imageSource:        "qrc:///qml/VehicleUpsideDown.png"
462 463
                    }
                    VehicleRotationCal {
Don Gagne's avatar
Don Gagne committed
464
                        visible:            controller.orientationCalNoseDownSideVisible
Don Gagne's avatar
Don Gagne committed
465 466
                        calValid:           controller.orientationCalNoseDownSideDone
                        calInProgress:      controller.orientationCalNoseDownSideInProgress
Don Gagne's avatar
Don Gagne committed
467 468
                        calInProgressText:  controller.orientationCalNoseDownSideRotate ? "Rotate" : "Hold Still"
                        imageSource:        controller.orientationCalNoseDownSideRotate ? "qrc:///qml/VehicleNoseDownRotate.png" : "qrc:///qml/VehicleNoseDown.png"
469 470
                    }
                    VehicleRotationCal {
Don Gagne's avatar
Don Gagne committed
471
                        visible:            controller.orientationCalTailDownSideVisible
Don Gagne's avatar
Don Gagne committed
472 473
                        calValid:           controller.orientationCalTailDownSideDone
                        calInProgress:      controller.orientationCalTailDownSideInProgress
Don Gagne's avatar
Don Gagne committed
474
                        calInProgressText:  "Hold Still"
Don Gagne's avatar
Don Gagne committed
475
                        imageSource:        "qrc:///qml/VehicleTailDown.png"
476 477
                    }
                    VehicleRotationCal {
Don Gagne's avatar
Don Gagne committed
478
                        visible:            controller.orientationCalLeftSideVisible
Don Gagne's avatar
Don Gagne committed
479 480
                        calValid:           controller.orientationCalLeftSideDone
                        calInProgress:      controller.orientationCalLeftSideInProgress
Don Gagne's avatar
Don Gagne committed
481 482
                        calInProgressText:  controller.orientationCalLeftSideRotate ? "Rotate" : "Hold Still"
                        imageSource:        controller.orientationCalLeftSideRotate ? "qrc:///qml/VehicleLeftRotate.png" : "qrc:///qml/VehicleLeft.png"
483 484
                    }
                    VehicleRotationCal {
Don Gagne's avatar
Don Gagne committed
485
                        visible:            controller.orientationCalRightSideVisible
Don Gagne's avatar
Don Gagne committed
486 487
                        calValid:           controller.orientationCalRightSideDone
                        calInProgress:      controller.orientationCalRightSideInProgress
Don Gagne's avatar
Don Gagne committed
488
                        calInProgressText:  "Hold Still"
Don Gagne's avatar
Don Gagne committed
489
                        imageSource:        "qrc:///qml/VehicleRight.png"
490 491 492 493
                    }
                }
            }

Don Gagne's avatar
Don Gagne committed
494 495 496 497 498 499
            Column {
                x: parent.width - rotationColumnWidth

                QGCLabel { text: "Autpilot Orientation" }

                FactComboBox {
500
                    id:     boardRotationCombo
Don Gagne's avatar
Don Gagne committed
501 502
                    width:  rotationColumnWidth;
                    model:  rotations
503
                    fact:   Fact { name: "SENS_BOARD_ROT" }
Don Gagne's avatar
Don Gagne committed
504 505 506 507
                }

                // Compass 0 rotation
                Component {
Don Gagne's avatar
Don Gagne committed
508
                    id: compass0ComponentLabel2
Don Gagne's avatar
Don Gagne committed
509 510 511 512

                    QGCLabel { text: "Compass Orientation" }
                }
                Component {
Don Gagne's avatar
Don Gagne committed
513
                    id: compass0ComponentCombo2
Don Gagne's avatar
Don Gagne committed
514 515

                    FactComboBox {
516
                        id:     compass0RotationCombo
Don Gagne's avatar
Don Gagne committed
517 518
                        width:  rotationColumnWidth
                        model:  rotations
519
                        fact:   Fact { name: "CAL_MAG0_ROT" }
Don Gagne's avatar
Don Gagne committed
520 521
                    }
                }
Don Gagne's avatar
Don Gagne committed
522 523
                Loader { sourceComponent: showCompass0Rot ? compass0ComponentLabel2 : null }
                Loader { sourceComponent: showCompass0Rot ? compass0ComponentCombo2 : null }
Don Gagne's avatar
Don Gagne committed
524 525 526

                // Compass 1 rotation
                Component {
Don Gagne's avatar
Don Gagne committed
527
                    id: compass1ComponentLabel2
Don Gagne's avatar
Don Gagne committed
528 529 530 531

                    QGCLabel { text: "Compass 1 Orientation" }
                }
                Component {
Don Gagne's avatar
Don Gagne committed
532
                    id: compass1ComponentCombo2
Don Gagne's avatar
Don Gagne committed
533 534

                    FactComboBox {
535
                        id:     compass1RotationCombo
Don Gagne's avatar
Don Gagne committed
536 537
                        width:  rotationColumnWidth
                        model:  rotations
538
                        fact:   Fact { name: "CAL_MAG1_ROT" }
Don Gagne's avatar
Don Gagne committed
539 540
                    }
                }
Don Gagne's avatar
Don Gagne committed
541 542
                Loader { sourceComponent: showCompass1Rot ? compass1ComponentLabel2 : null }
                Loader { sourceComponent: showCompass1Rot ? compass1ComponentCombo2 : null }
Don Gagne's avatar
Don Gagne committed
543 544 545

                // Compass 2 rotation
                Component {
Don Gagne's avatar
Don Gagne committed
546
                    id: compass2ComponentLabel2
Don Gagne's avatar
Don Gagne committed
547 548 549 550

                    QGCLabel { text: "Compass 2 Orientation" }
                }
                Component {
Don Gagne's avatar
Don Gagne committed
551
                    id: compass2ComponentCombo2
Don Gagne's avatar
Don Gagne committed
552 553

                    FactComboBox {
554
                        id:     compass1RotationCombo
Don Gagne's avatar
Don Gagne committed
555 556
                        width:  rotationColumnWidth
                        model:  rotations
557
                        fact:   Fact { name: "CAL_MAG2_ROT" }
Don Gagne's avatar
Don Gagne committed
558 559
                    }
                }
Don Gagne's avatar
Don Gagne committed
560 561
                Loader { sourceComponent: showCompass2Rot ? compass2ComponentLabel2 : null }
                Loader { sourceComponent: showCompass2Rot ? compass2ComponentCombo2 : null }
Don Gagne's avatar
Don Gagne committed
562 563 564 565 566
            }
        }
    }
}