FWLandingPatternMapVisual.qml 18.5 KB
Newer Older
1 2 3 4 5 6 7 8 9
/****************************************************************************
 *
 *   (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.
 *
 ****************************************************************************/

10 11 12 13
import QtQuick          2.3
import QtQuick.Controls 1.2
import QtLocation       5.3
import QtPositioning    5.3
14
import QtQuick.Layouts  1.11
15

16
import QGroundControl               1.0
17 18 19
import QGroundControl.ScreenTools   1.0
import QGroundControl.Palette       1.0
import QGroundControl.Controls      1.0
20
import QGroundControl.FlightMap     1.0
21 22 23

/// Fixed Wing Landing Pattern map visuals
Item {
24 25
    id: _root

DonLakeFlyer's avatar
DonLakeFlyer committed
26
    property var map        ///< Map control to place item in
27

28 29
    signal clicked(int sequenceNumber)

Don Gagne's avatar
Don Gagne committed
30 31 32
    readonly property real _landingWidthMeters:     15
    readonly property real _landingLengthMeters:    100

33
    property var    _missionItem:               object
Don Gagne's avatar
Don Gagne committed
34
    property var    _mouseArea
35
    property var    _dragAreas:                 [ ]
Don Gagne's avatar
Don Gagne committed
36
    property var    _flightPath
37
    property real   _landingAreaBearing:        _missionItem.landingCoordinate.azimuthTo(_missionItem.loiterTangentCoordinate)
Don Gagne's avatar
Don Gagne committed
38 39
    property var    _loiterPointObject
    property var    _landingPointObject
40 41 42 43 44 45 46 47 48 49 50 51 52 53 54
    property real   _transitionAltitudeMeters
    property real   _midSlopeAltitudeMeters
    property real   _landingAltitudeMeters:     _missionItem.landingAltitude.rawValue
    property real   _loiterAltitudeMeters:      _missionItem.loiterAltitude.rawValue

    function _calcGlideSlopeHeights() {
        var adjacent = _missionItem.landingCoordinate.distanceTo(_missionItem.loiterTangentCoordinate)
        var opposite = _loiterAltitudeMeters - _landingAltitudeMeters
        var angleRadians = Math.atan(opposite / adjacent)
        var transitionDistance = _landingLengthMeters / 2
        var glideSlopeDistance = adjacent - transitionDistance

        _transitionAltitudeMeters = Math.tan(angleRadians) * (transitionDistance)
        _midSlopeAltitudeMeters = Math.tan(angleRadians) * (transitionDistance + (glideSlopeDistance / 2))
    }
55

56
    function hideItemVisuals() {
57
        objMgr.destroyObjects()
58 59 60
    }

    function showItemVisuals() {
61 62 63
        if (objMgr.rgDynamicObjects.length === 0) {
            _loiterPointObject = objMgr.createObject(loiterPointComponent, map, true /* parentObjectIsMap */)
            _landingPointObject = objMgr.createObject(landingPointComponent, map, true /* parentObjectIsMap */)
Don Gagne's avatar
Don Gagne committed
64

65 66 67
            var rgComponents = [ flightPathComponent, loiterRadiusComponent, landingAreaComponent, landingAreaLabelComponent,
                                glideSlopeComponent, glideSlopeLabelComponent, transitionHeightComponent, midGlideSlopeHeightComponent,
                                approachHeightComponent ]
68
            objMgr.createObjects(rgComponents, map, true /* parentObjectIsMap */)
69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86
        }
    }

    function hideMouseArea() {
        if (_mouseArea) {
            _mouseArea.destroy()
            _mouseArea = undefined
        }
    }

    function showMouseArea() {
        if (!_mouseArea) {
            _mouseArea = mouseAreaComponent.createObject(map)
            map.addMapItem(_mouseArea)
        }
    }

    function hideDragAreas() {
Don Gagne's avatar
Don Gagne committed
87 88
        for (var i=0; i<_dragAreas.length; i++) {
            _dragAreas[i].destroy()
89
        }
Don Gagne's avatar
Don Gagne committed
90
        _dragAreas = [ ]
91 92 93
    }

    function showDragAreas() {
Don Gagne's avatar
Don Gagne committed
94
        if (_dragAreas.length === 0) {
95 96
            _dragAreas.push(loiterDragAreaComponent.createObject(map))
            _dragAreas.push(landDragAreaComponent.createObject(map))
97 98 99
        }
    }

100 101
    function _setFlightPath() {
        _flightPath = [ _missionItem.loiterTangentCoordinate, _missionItem.landingCoordinate ]
102 103
    }

104 105 106 107
    QGCDynamicObjectManager {
        id: objMgr
    }

108
    Component.onCompleted: {
109 110
        if (_missionItem.landingCoordSet) {
            showItemVisuals()
111
            if (!_missionItem.flyView && _missionItem.isCurrentItem) {
112 113
                showDragAreas()
            }
114
            _setFlightPath()
115
        } else if (!_missionItem.flyView && _missionItem.isCurrentItem) {
116 117
            showMouseArea()
        }
118 119 120
    }

    Component.onDestruction: {
121 122 123 124 125
        hideDragAreas()
        hideMouseArea()
        hideItemVisuals()
    }

126 127 128
    on_LandingAltitudeMetersChanged:    _calcGlideSlopeHeights()
    on_LoiterAltitudeMetersChanged:     _calcGlideSlopeHeights()

129 130 131 132
    Connections {
        target: _missionItem

        onIsCurrentItemChanged: {
133 134 135
            if (_missionItem.flyView) {
                return
            }
136 137 138 139 140 141 142 143 144 145 146 147 148
            if (_missionItem.isCurrentItem) {
                if (_missionItem.landingCoordSet) {
                    showDragAreas()
                } else {
                    showMouseArea()
                }
            } else {
                hideMouseArea()
                hideDragAreas()
            }
        }

        onLandingCoordSetChanged: {
149 150 151
            if (_missionItem.flyView) {
                return
            }
152 153 154 155
            if (_missionItem.landingCoordSet) {
                hideMouseArea()
                showItemVisuals()
                showDragAreas()
156
                _setFlightPath()
157 158 159 160 161
            } else if (_missionItem.isCurrentItem) {
                hideDragAreas()
                showMouseArea()
            }
        }
162

163 164 165 166 167 168 169 170 171
        onLandingCoordinateChanged: {
            _calcGlideSlopeHeights()
            _setFlightPath()
        }

        onLoiterTangentCoordinateChanged: {
            _calcGlideSlopeHeights()
            _setFlightPath()
        }
172 173 174 175 176 177 178
    }

    // Mouse area to capture landing point coordindate
    Component {
        id:  mouseAreaComponent

        MouseArea {
179 180
            anchors.fill:   map
            z:              QGroundControl.zOrderMapItems + 1   // Over item indicators
181

182 183
            readonly property int   _decimalPlaces:             8

184
            onClicked: {
DonLakeFlyer's avatar
DonLakeFlyer committed
185
                var coordinate = map.toCoordinate(Qt.point(mouse.x, mouse.y), false /* clipToViewPort */)
186 187 188 189 190 191 192 193
                coordinate.latitude = coordinate.latitude.toFixed(_decimalPlaces)
                coordinate.longitude = coordinate.longitude.toFixed(_decimalPlaces)
                coordinate.altitude = coordinate.altitude.toFixed(_decimalPlaces)
                _missionItem.landingCoordinate = coordinate
            }
        }
    }

194
    // Control which is used to drag the loiter point
195
    Component {
196
        id: loiterDragAreaComponent
197

198
        MissionItemIndicatorDrag {
199
            mapControl:     _root.map
Don Gagne's avatar
Don Gagne committed
200
            itemIndicator:  _loiterPointObject
201
            itemCoordinate: _missionItem.loiterCoordinate
202

203 204 205 206 207 208 209 210 211 212 213 214 215 216 217
            property bool _preventReentrancy: false

            onItemCoordinateChanged: {
                if (!_preventReentrancy) {
                    if (Drag.active && _missionItem.loiterDragAngleOnly) {
                        _preventReentrancy = true
                        var angle = _missionItem.landingCoordinate.azimuthTo(itemCoordinate)
                        var distance = _missionItem.landingCoordinate.distanceTo(_missionItem.loiterCoordinate)
                        _missionItem.loiterCoordinate = _missionItem.landingCoordinate.atDistanceAndAzimuth(distance, angle)
                        _preventReentrancy = false
                    } else {
                        _missionItem.loiterCoordinate = itemCoordinate
                    }
                }
            }
218 219 220
        }
    }

221
    // Control which is used to drag the landing point
222 223 224 225
    Component {
        id: landDragAreaComponent

        MissionItemIndicatorDrag {
226
            mapControl:     _root.map
Don Gagne's avatar
Don Gagne committed
227
            itemIndicator:  _landingPointObject
228
            itemCoordinate: _missionItem.landingCoordinate
229

230
            onItemCoordinateChanged: _missionItem.landingCoordinate = itemCoordinate
231
        }
232 233 234 235 236 237 238
    }

    // Flight path
    Component {
        id: flightPathComponent

        MapPolyline {
239
            z:          QGroundControl.zOrderMapItems - 1   // Under item indicators
Don Gagne's avatar
Don Gagne committed
240
            line.color: "#be781c"
241
            line.width: 2
242
            path:       _flightPath
243 244 245 246 247
        }
    }

    // Loiter point
    Component {
248
        id: loiterPointComponent
249 250

        MapQuickItem {
251 252
            anchorPoint.x:  sourceItem.anchorPointX
            anchorPoint.y:  sourceItem.anchorPointY
253 254
            z:              QGroundControl.zOrderMapItems
            coordinate:     _missionItem.loiterCoordinate
255 256 257

            sourceItem:
                MissionItemIndexLabel {
258
                index:      _missionItem.sequenceNumber
259 260 261
                label:      "Loiter"
                checked:    _missionItem.isCurrentItem

262
                onClicked: _root.clicked(_missionItem.sequenceNumber)
263 264 265 266
            }
        }
    }

Don Gagne's avatar
Don Gagne committed
267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286
    // Landing point
    Component {
        id: landingPointComponent

        MapQuickItem {
            anchorPoint.x:  sourceItem.anchorPointX
            anchorPoint.y:  sourceItem.anchorPointY
            z:              QGroundControl.zOrderMapItems
            coordinate:     _missionItem.landingCoordinate

            sourceItem:
                MissionItemIndexLabel {
                index:      _missionItem.sequenceNumber
                checked:    _missionItem.isCurrentItem

                onClicked: _root.clicked(_missionItem.sequenceNumber)
            }
        }
    }

Don Gagne's avatar
Don Gagne committed
287 288 289 290 291 292
    Component {
        id: loiterRadiusComponent

        MapCircle {
            z:              QGroundControl.zOrderMapItems
            center:         _missionItem.loiterCoordinate
293
            radius:         _missionItem.loiterRadius.rawValue
Don Gagne's avatar
Don Gagne committed
294 295 296 297 298 299
            border.width:   2
            border.color:   "green"
            color:          "transparent"
        }
    }

300
    Component {
Don Gagne's avatar
Don Gagne committed
301
        id: landingAreaLabelComponent
302 303

        MapQuickItem {
Don Gagne's avatar
Don Gagne committed
304 305
            anchorPoint.x:  sourceItem.contentWidth / 2
            anchorPoint.y:  sourceItem.contentHeight / 2
306 307
            z:              QGroundControl.zOrderMapItems
            coordinate:     _missionItem.landingCoordinate
Don Gagne's avatar
Don Gagne committed
308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327
            visible:        _missionItem.isCurrentItem

            sourceItem: QGCLabel {
                id:     landingAreaLabel
                text:   qsTr("Landing Area")
                color:  "white"

                property real _rawBearing:      _landingAreaBearing
                property real _adjustedBearing

                on_RawBearingChanged: {
                    _adjustedBearing = _rawBearing
                    if (_adjustedBearing > 180) {
                        _adjustedBearing -= 180
                    }
                    _adjustedBearing -= 90
                    if (_adjustedBearing < 0) {
                        _adjustedBearing += 360
                    }
                }
328

Don Gagne's avatar
Don Gagne committed
329 330 331 332 333 334 335 336
                transform: Rotation {
                    origin.x:   landingAreaLabel.width / 2
                    origin.y:   landingAreaLabel.height / 2
                    angle:      landingAreaLabel._adjustedBearing
                }
            }
        }
    }
337

Don Gagne's avatar
Don Gagne committed
338 339 340 341
    Component {
        id: glideSlopeLabelComponent

        MapQuickItem {
342
            anchorPoint.x:  sourceItem._rawBearing > 180 ? sourceItem.contentWidth : 0
Don Gagne's avatar
Don Gagne committed
343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366
            anchorPoint.y:  sourceItem.contentHeight / 2
            z:              QGroundControl.zOrderMapItems
            visible:        _missionItem.isCurrentItem

            sourceItem: QGCLabel {
                id:     glideSlopeLabel
                text:   qsTr("Glide Slope")
                color:  "white"

                property real _rawBearing:      _landingAreaBearing
                property real _adjustedBearing

                on_RawBearingChanged: {
                    _adjustedBearing = _rawBearing
                    if (_adjustedBearing > 180) {
                        _adjustedBearing -= 180
                    }
                    _adjustedBearing -= 90
                    if (_adjustedBearing < 0) {
                        _adjustedBearing += 360
                    }
                }

                transform: Rotation {
367
                    origin.x:   sourceItem._rawBearing > 180 ? sourceItem.contentWidth : 0
Don Gagne's avatar
Don Gagne committed
368 369 370 371 372 373 374 375 376 377 378 379 380 381 382
                    origin.y:   glideSlopeLabel.contentHeight / 2
                    angle:      glideSlopeLabel._adjustedBearing
                }
            }

            function recalc() {
                coordinate = _missionItem.landingCoordinate.atDistanceAndAzimuth(_landingLengthMeters / 2 + 2, _landingAreaBearing)
            }

            Component.onCompleted: recalc()

            Connections {
                target:                             _missionItem
                onLandingCoordinateChanged:         recalc()
                onLoiterTangentCoordinateChanged:   recalc()
383
            }
384 385
        }
    }
DonLakeFlyer's avatar
DonLakeFlyer committed
386 387 388 389

    Component {
        id: landingAreaComponent

DonLakeFlyer's avatar
DonLakeFlyer committed
390
        MapPolygon {
DonLakeFlyer's avatar
DonLakeFlyer committed
391 392 393 394 395 396
            z:              QGroundControl.zOrderMapItems
            border.width:   1
            border.color:   "black"
            color:          "green"
            opacity:        0.5

Don Gagne's avatar
Don Gagne committed
397
            readonly property real angleRadians:    Math.atan((_landingWidthMeters / 2) / (_landingLengthMeters / 2))
DonLakeFlyer's avatar
DonLakeFlyer committed
398
            readonly property real angleDegrees:    (angleRadians * (180 / Math.PI))
Don Gagne's avatar
Don Gagne committed
399 400 401 402 403 404 405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424 425 426 427
            readonly property real hypotenuse:      (_landingWidthMeters / 2) / Math.sin(angleRadians)

            function recalc() {
                path = [ ]
                addCoordinate(_missionItem.landingCoordinate.atDistanceAndAzimuth(hypotenuse, _landingAreaBearing - angleDegrees))
                addCoordinate(_missionItem.landingCoordinate.atDistanceAndAzimuth(hypotenuse, _landingAreaBearing + angleDegrees))
                addCoordinate(_missionItem.landingCoordinate.atDistanceAndAzimuth(hypotenuse, _landingAreaBearing + (180 - angleDegrees)))
                addCoordinate(_missionItem.landingCoordinate.atDistanceAndAzimuth(hypotenuse, _landingAreaBearing - (180 - angleDegrees)))
            }

            Component.onCompleted: recalc()

            Connections {
                target:                             _missionItem
                onLandingCoordinateChanged:         recalc()
                onLoiterTangentCoordinateChanged:   recalc()
            }
        }
    }

    Component {
        id: glideSlopeComponent

        MapPolygon {
            z:              QGroundControl.zOrderMapItems
            border.width:   1
            border.color:   "black"
            color:          "orange"
            opacity:        0.5
DonLakeFlyer's avatar
DonLakeFlyer committed
428

Don Gagne's avatar
Don Gagne committed
429 430 431
            readonly property real angleRadians:    Math.atan((_landingWidthMeters / 2) / (_landingLengthMeters / 2))
            readonly property real angleDegrees:    (angleRadians * (180 / Math.PI))
            readonly property real hypotenuse:      (_landingWidthMeters / 2) / Math.sin(angleRadians)
DonLakeFlyer's avatar
DonLakeFlyer committed
432

Don Gagne's avatar
Don Gagne committed
433
            function recalc() {
DonLakeFlyer's avatar
DonLakeFlyer committed
434
                path = [ ]
Don Gagne's avatar
Don Gagne committed
435 436 437
                addCoordinate(_missionItem.landingCoordinate.atDistanceAndAzimuth(hypotenuse, _landingAreaBearing - angleDegrees))
                addCoordinate(_missionItem.landingCoordinate.atDistanceAndAzimuth(hypotenuse, _landingAreaBearing + angleDegrees))
                addCoordinate(_missionItem.loiterTangentCoordinate)
DonLakeFlyer's avatar
DonLakeFlyer committed
438 439
            }

Don Gagne's avatar
Don Gagne committed
440
            Component.onCompleted: recalc()
DonLakeFlyer's avatar
DonLakeFlyer committed
441 442

            Connections {
Don Gagne's avatar
Don Gagne committed
443 444 445
                target:                             _missionItem
                onLandingCoordinateChanged:         recalc()
                onLoiterTangentCoordinateChanged:   recalc()
DonLakeFlyer's avatar
DonLakeFlyer committed
446
            }
DonLakeFlyer's avatar
DonLakeFlyer committed
447 448
        }
    }
449 450 451 452 453 454 455 456 457 458 459

    Component {
        id: transitionHeightComponent

        MapQuickItem {
            anchorPoint.x:  sourceItem.width / 2
            anchorPoint.y:  0
            z:              QGroundControl.zOrderMapItems
            visible:        _missionItem.isCurrentItem

            sourceItem: HeightIndicator {
DonLakeFlyer's avatar
DonLakeFlyer committed
460
                map:        _root.map
461 462
                heightText: Math.floor(QGroundControl.metersToAppSettingsDistanceUnits(_transitionAltitudeMeters)) +
                            QGroundControl.appSettingsDistanceUnitsString + "<sup>*</sup>"
463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491
            }

            function recalc() {
                var centeredCoordinate = _missionItem.landingCoordinate.atDistanceAndAzimuth(_landingLengthMeters / 2, _landingAreaBearing)
                var angleIncrement = _landingAreaBearing > 180 ? -90 : 90
                coordinate = centeredCoordinate.atDistanceAndAzimuth(_landingWidthMeters, _landingAreaBearing + angleIncrement)
            }

            Component.onCompleted: recalc()

            Connections {
                target:                             _missionItem
                onLandingCoordinateChanged:         recalc()
                onLoiterTangentCoordinateChanged:   recalc()
            }

        }
    }

    Component {
        id: midGlideSlopeHeightComponent

        MapQuickItem {
            anchorPoint.x:  sourceItem.width / 2
            anchorPoint.y:  0
            z:              QGroundControl.zOrderMapItems
            visible:        _missionItem.isCurrentItem

            sourceItem: HeightIndicator {
DonLakeFlyer's avatar
DonLakeFlyer committed
492
                map:        _root.map
493 494
                heightText: Math.floor(QGroundControl.metersToAppSettingsDistanceUnits(_midSlopeAltitudeMeters)) +
                            QGroundControl.appSettingsDistanceUnitsString + "<sup>*</sup>"
495 496 497 498 499 500 501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526
            }

            function recalc() {
                var transitionCoordinate = _missionItem.landingCoordinate.atDistanceAndAzimuth(_landingLengthMeters / 2, _landingAreaBearing)
                var halfDistance = transitionCoordinate.distanceTo(_missionItem.loiterTangentCoordinate) / 2
                var centeredCoordinate = transitionCoordinate.atDistanceAndAzimuth(halfDistance, _landingAreaBearing)
                var angleIncrement = _landingAreaBearing > 180 ? -90 : 90
                coordinate = centeredCoordinate.atDistanceAndAzimuth(_landingWidthMeters / 2, _landingAreaBearing + angleIncrement)
            }

            Component.onCompleted: recalc()

            Connections {
                target:                             _missionItem
                onLandingCoordinateChanged:         recalc()
                onLoiterTangentCoordinateChanged:   recalc()
            }

        }
    }

    Component {
        id: approachHeightComponent

        MapQuickItem {
            anchorPoint.x:  sourceItem.width / 2
            anchorPoint.y:  0
            z:              QGroundControl.zOrderMapItems
            visible:        _missionItem.isCurrentItem
            coordinate:     _missionItem.loiterTangentCoordinate

            sourceItem: HeightIndicator {
DonLakeFlyer's avatar
DonLakeFlyer committed
527
                map:        _root.map
528
                heightText: _missionItem.loiterAltitude.value.toFixed(1) + QGroundControl.appSettingsDistanceUnitsString
529 530 531
            }
        }
    }
532
}