FWLandingPatternMapVisual.qml 18.3 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

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

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

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

201 202 203 204 205 206 207 208 209 210 211 212 213 214 215
            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
                    }
                }
            }
216 217 218
        }
    }

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

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

228
            onItemCoordinateChanged: _missionItem.landingCoordinate = itemCoordinate
229
        }
230 231 232 233 234 235 236
    }

    // Flight path
    Component {
        id: flightPathComponent

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

    // Loiter point
    Component {
246
        id: loiterPointComponent
247 248

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

            sourceItem:
                MissionItemIndexLabel {
256
                index:      _missionItem.sequenceNumber
257 258 259
                label:      "Loiter"
                checked:    _missionItem.isCurrentItem

260
                onClicked: _root.clicked(_missionItem.sequenceNumber)
261 262 263 264
            }
        }
    }

Don Gagne's avatar
Don Gagne committed
265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284
    // 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
285 286 287 288 289 290
    Component {
        id: loiterRadiusComponent

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

298
    Component {
Don Gagne's avatar
Don Gagne committed
299
        id: landingAreaLabelComponent
300 301

        MapQuickItem {
Don Gagne's avatar
Don Gagne committed
302 303
            anchorPoint.x:  sourceItem.contentWidth / 2
            anchorPoint.y:  sourceItem.contentHeight / 2
304 305
            z:              QGroundControl.zOrderMapItems
            coordinate:     _missionItem.landingCoordinate
Don Gagne's avatar
Don Gagne committed
306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325
            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
                    }
                }
326

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

Don Gagne's avatar
Don Gagne committed
336 337 338 339
    Component {
        id: glideSlopeLabelComponent

        MapQuickItem {
340
            anchorPoint.x:  sourceItem._rawBearing > 180 ? sourceItem.contentWidth : 0
Don Gagne's avatar
Don Gagne committed
341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364
            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 {
365
                    origin.x:   sourceItem._rawBearing > 180 ? sourceItem.contentWidth : 0
Don Gagne's avatar
Don Gagne committed
366 367 368 369 370 371 372 373 374 375 376 377 378 379 380
                    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()
381
            }
382 383
        }
    }
DonLakeFlyer's avatar
DonLakeFlyer committed
384 385 386 387

    Component {
        id: landingAreaComponent

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

Don Gagne's avatar
Don Gagne committed
395
            readonly property real angleRadians:    Math.atan((_landingWidthMeters / 2) / (_landingLengthMeters / 2))
DonLakeFlyer's avatar
DonLakeFlyer committed
396
            readonly property real angleDegrees:    (angleRadians * (180 / Math.PI))
Don Gagne's avatar
Don Gagne committed
397 398 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
            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
426

Don Gagne's avatar
Don Gagne committed
427 428 429
            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
430

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

Don Gagne's avatar
Don Gagne committed
438
            Component.onCompleted: recalc()
DonLakeFlyer's avatar
DonLakeFlyer committed
439 440

            Connections {
Don Gagne's avatar
Don Gagne committed
441 442 443
                target:                             _missionItem
                onLandingCoordinateChanged:         recalc()
                onLoiterTangentCoordinateChanged:   recalc()
DonLakeFlyer's avatar
DonLakeFlyer committed
444
            }
DonLakeFlyer's avatar
DonLakeFlyer committed
445 446
        }
    }
447 448 449 450 451 452 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 481 482 483 484 485 486 487 488 489 490 491 492 493 494 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

    Component {
        id: transitionHeightComponent

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

            sourceItem: HeightIndicator {
                heightText: QGroundControl.metersToAppSettingsDistanceUnits(_transitionAltitudeMeters).toFixed(1) + " " +
                            QGroundControl.appSettingsDistanceUnitsString
            }

            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 {
                heightText: QGroundControl.metersToAppSettingsDistanceUnits(_midSlopeAltitudeMeters).toFixed(1) + " " +
                            QGroundControl.appSettingsDistanceUnitsString
            }

            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 {
                heightText: _missionItem.loiterAltitude.value.toFixed(1) + " " + QGroundControl.appSettingsDistanceUnitsString
            }
        }
    }
527
}