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

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

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

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

27 28
    signal clicked(int sequenceNumber)

29
    property var _missionItem:  object
Don Gagne's avatar
Don Gagne committed
30
    property var _itemVisuals: [ ]
31
    property var _mouseArea
Don Gagne's avatar
Don Gagne committed
32
    property var _dragAreas: [ ]
33
    property var _flightPath
Don Gagne's avatar
Don Gagne committed
34 35 36 37

    readonly property int _flightPathIndex:     0
    readonly property int _loiterPointIndex:    1
    readonly property int _loiterRadiusIndex:   2
DonLakeFlyer's avatar
DonLakeFlyer committed
38 39
    readonly property int _landingAreaIndex:    3
    readonly property int _landPointIndex:      4
40

41
    function hideItemVisuals() {
Don Gagne's avatar
Don Gagne committed
42 43
        for (var i=0; i<_itemVisuals.length; i++) {
            _itemVisuals[i].destroy()
44
        }
Don Gagne's avatar
Don Gagne committed
45
        _itemVisuals = [ ]
46 47 48
    }

    function showItemVisuals() {
Don Gagne's avatar
Don Gagne committed
49 50 51 52 53 54 55 56 57 58
        if (_itemVisuals.length === 0) {
            var itemVisual = flightPathComponent.createObject(map)
            map.addMapItem(itemVisual)
            _itemVisuals[_flightPathIndex] =itemVisual
            itemVisual = loiterPointComponent.createObject(map)
            map.addMapItem(itemVisual)
            _itemVisuals[_loiterPointIndex] = itemVisual
            itemVisual = loiterRadiusComponent.createObject(map)
            map.addMapItem(itemVisual)
            _itemVisuals[_loiterRadiusIndex] = itemVisual
DonLakeFlyer's avatar
DonLakeFlyer committed
59 60 61
            itemVisual = landingAreaComponent.createObject(map)
            map.addMapItem(itemVisual)
            _itemVisuals[_landingAreaIndex] = itemVisual
Don Gagne's avatar
Don Gagne committed
62 63 64
            itemVisual = landPointComponent.createObject(map)
            map.addMapItem(itemVisual)
            _itemVisuals[_landPointIndex] = itemVisual
65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82
        }
    }

    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
83 84
        for (var i=0; i<_dragAreas.length; i++) {
            _dragAreas[i].destroy()
85
        }
Don Gagne's avatar
Don Gagne committed
86
        _dragAreas = [ ]
87 88 89
    }

    function showDragAreas() {
Don Gagne's avatar
Don Gagne committed
90
        if (_dragAreas.length === 0) {
91 92
            _dragAreas.push(loiterDragAreaComponent.createObject(map))
            _dragAreas.push(landDragAreaComponent.createObject(map))
93 94 95
        }
    }

96 97
    function _setFlightPath() {
        _flightPath = [ _missionItem.loiterTangentCoordinate, _missionItem.landingCoordinate ]
98 99
    }

100
    Component.onCompleted: {
101 102
        if (_missionItem.landingCoordSet) {
            showItemVisuals()
103
            if (!_missionItem.flyView && _missionItem.isCurrentItem) {
104 105
                showDragAreas()
            }
106
            _setFlightPath()
107
        } else if (!_missionItem.flyView && _missionItem.isCurrentItem) {
108 109
            showMouseArea()
        }
110 111 112
    }

    Component.onDestruction: {
113 114 115 116 117 118 119 120 121
        hideDragAreas()
        hideMouseArea()
        hideItemVisuals()
    }

    Connections {
        target: _missionItem

        onIsCurrentItemChanged: {
122 123 124
            if (_missionItem.flyView) {
                return
            }
125 126 127 128 129 130 131 132 133 134 135 136 137
            if (_missionItem.isCurrentItem) {
                if (_missionItem.landingCoordSet) {
                    showDragAreas()
                } else {
                    showMouseArea()
                }
            } else {
                hideMouseArea()
                hideDragAreas()
            }
        }

        onLandingCoordSetChanged: {
138 139 140
            if (_missionItem.flyView) {
                return
            }
141 142 143 144
            if (_missionItem.landingCoordSet) {
                hideMouseArea()
                showItemVisuals()
                showDragAreas()
145
                _setFlightPath()
146 147 148 149 150
            } else if (_missionItem.isCurrentItem) {
                hideDragAreas()
                showMouseArea()
            }
        }
151

152 153
        onLandingCoordinateChanged:         _setFlightPath()
        onLoiterTangentCoordinateChanged:   _setFlightPath()
154 155 156 157 158 159 160
    }

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

        MouseArea {
161 162
            anchors.fill:   map
            z:              QGroundControl.zOrderMapItems + 1   // Over item indicators
163 164

            onClicked: {
DonLakeFlyer's avatar
DonLakeFlyer committed
165
                var coordinate = map.toCoordinate(Qt.point(mouse.x, mouse.y), false /* clipToViewPort */)
166 167 168 169 170 171 172 173
                coordinate.latitude = coordinate.latitude.toFixed(_decimalPlaces)
                coordinate.longitude = coordinate.longitude.toFixed(_decimalPlaces)
                coordinate.altitude = coordinate.altitude.toFixed(_decimalPlaces)
                _missionItem.landingCoordinate = coordinate
            }
        }
    }

174
    // Control which is used to drag the loiter point
175
    Component {
176
        id: loiterDragAreaComponent
177

178
        MissionItemIndicatorDrag {
179
            mapControl:     _root.map
180 181
            itemIndicator:  _itemVisuals[_loiterPointIndex]
            itemCoordinate: _missionItem.loiterCoordinate
182

183
            onItemCoordinateChanged: _missionItem.loiterCoordinate = itemCoordinate
184 185 186 187 188 189 190 191
        }
    }

    // Control which is used to drag the loiter point
    Component {
        id: landDragAreaComponent

        MissionItemIndicatorDrag {
192
            mapControl:     _root.map
193 194
            itemIndicator:  _itemVisuals[_landPointIndex]
            itemCoordinate: _missionItem.landingCoordinate
195

196
            onItemCoordinateChanged: _missionItem.landingCoordinate = itemCoordinate
197
        }
198 199 200 201 202 203 204
    }

    // Flight path
    Component {
        id: flightPathComponent

        MapPolyline {
205
            z:          QGroundControl.zOrderMapItems - 1   // Under item indicators
Don Gagne's avatar
Don Gagne committed
206
            line.color: "#be781c"
207
            line.width: 2
208
            path:       _flightPath
209 210 211 212 213
        }
    }

    // Loiter point
    Component {
214
        id: loiterPointComponent
215 216

        MapQuickItem {
217 218
            anchorPoint.x:  sourceItem.anchorPointX
            anchorPoint.y:  sourceItem.anchorPointY
219 220
            z:              QGroundControl.zOrderMapItems
            coordinate:     _missionItem.loiterCoordinate
221 222 223

            sourceItem:
                MissionItemIndexLabel {
224
                index:      _missionItem.sequenceNumber
225 226 227
                label:      "Loiter"
                checked:    _missionItem.isCurrentItem

228
                onClicked: _root.clicked(_missionItem.sequenceNumber)
229 230 231 232
            }
        }
    }

Don Gagne's avatar
Don Gagne committed
233 234 235 236 237 238
    Component {
        id: loiterRadiusComponent

        MapCircle {
            z:              QGroundControl.zOrderMapItems
            center:         _missionItem.loiterCoordinate
239
            radius:         _missionItem.loiterRadius.rawValue
Don Gagne's avatar
Don Gagne committed
240 241 242 243 244 245
            border.width:   2
            border.color:   "green"
            color:          "transparent"
        }
    }

246 247 248 249
    Component {
        id: landPointComponent

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

            sourceItem:
                MissionItemIndexLabel {
257
                index:      _missionItem.lastSequenceNumber
258
                label:      "Land"
Don Gagne's avatar
Don Gagne committed
259
                checked:    _missionItem.isCurrentItem
260

261
                onClicked: _root.clicked(_missionItem.sequenceNumber)
262
            }
263 264
        }
    }
DonLakeFlyer's avatar
DonLakeFlyer committed
265 266 267 268

    Component {
        id: landingAreaComponent

DonLakeFlyer's avatar
DonLakeFlyer committed
269
        MapPolygon {
DonLakeFlyer's avatar
DonLakeFlyer committed
270 271 272 273 274 275
            z:              QGroundControl.zOrderMapItems
            border.width:   1
            border.color:   "black"
            color:          "green"
            opacity:        0.5

DonLakeFlyer's avatar
DonLakeFlyer committed
276
            readonly property real landingWidth:    15
DonLakeFlyer's avatar
DonLakeFlyer committed
277 278
            readonly property real landingLength:   100
            readonly property real angleRadians:    Math.atan((landingWidth / 2) / (landingLength / 2))
DonLakeFlyer's avatar
DonLakeFlyer committed
279
            readonly property real angleDegrees:    (angleRadians * (180 / Math.PI))
DonLakeFlyer's avatar
DonLakeFlyer committed
280
            readonly property real hypotenuse:      (landingWidth / 2) / Math.sin(angleRadians)
DonLakeFlyer's avatar
DonLakeFlyer committed
281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298

            property real landingAreaAngle: _missionItem.landingCoordinate.azimuthTo(_missionItem.loiterTangentCoordinate)

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

            Component.onCompleted: calcPoly()

            Connections {
                target: _missionItem
                onLandingCoordinateChanged: calcPoly()
                onLoiterTangentCoordinateChanged:  calcPoly()
            }
DonLakeFlyer's avatar
DonLakeFlyer committed
299 300
        }
    }
301
}