MapFitFunctions.qml 7.01 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
import QtQuick          2.3
import QtPositioning    5.3
12

13 14
import QGroundControl           1.0
import QGroundControl.FlightMap 1.0
15 16 17 18 19

/// Set of functions for fitting the map viewpoer to a specific constraint
Item {
    property var    map
    property bool   usePlannedHomePosition      ///< true: planned home position used for calculations, false: vehicle home position use for calculations
Gus Grubba's avatar
Gus Grubba committed
20
    property var    planMasterController
21 22 23 24

    property var    _missionController:     planMasterController.missionController
    property var    _geoFenceController:    planMasterController.geoFenceController
    property var    _rallyPointController:  planMasterController.rallyPointController
25 26 27 28 29

    function fitHomePosition() {
        var homePosition = QtPositioning.coordinate()
        var activeVehicle = QGroundControl.multiVehicleManager.activeVehicle
        if (usePlannedHomePosition) {
30
            homePosition = _missionController.visualItems.get(0).coordinate
31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49
        } else if (activeVehicle) {
            homePosition = activeVehicle.homePosition
        }
        return homePosition
    }

    /// Normalize latitude to range: 0 to 180, S to N
    function normalizeLat(lat) {
        return lat + 90.0
    }

    /// Normalize longitude to range: 0 to 360, W to E
    function normalizeLon(lon) {
        return lon  + 180.0
    }

    /// Fits the visible region of the map to inclues all of the specified coordinates. If no coordinates
    /// are specified the map will center to fitHomePosition()
    function fitMapViewportToAllCoordinates(coordList) {
50
        var mapFitViewport = Qt.rect(0, 0, map.width, map.height)
51
        if (coordList.length === 0) {
Don Gagne's avatar
Don Gagne committed
52 53 54 55
            var homeCoord = fitHomePosition()
            if (homeCoord.isValid) {
                map.center = homeCoord
            }
56 57 58 59 60 61 62 63
            return
        }

        // Create the normalized lat/lon corners for the coordinate bounding rect from the list of coordinates
        var north = normalizeLat(coordList[0].latitude)
        var south = north
        var east = normalizeLon(coordList[0].longitude)
        var west = east
64
        for (var i = 1; i < coordList.length; i++) {
65 66 67 68
            var lat = normalizeLat(coordList[i].latitude)
            var lon = normalizeLon(coordList[i].longitude)
            north = Math.max(north, lat)
            south = Math.min(south, lat)
69 70
            east  = Math.max(east,  lon)
            west  = Math.min(west,  lon)
71 72 73 74
        }

        // Expand the coordinate bounding rect to make room for the tools around the edge of the map
        var latDegreesPerPixel = (north - south) / mapFitViewport.width
75
        var lonDegreesPerPixel = (east  - west)  / mapFitViewport.height
76 77
        north = Math.min(north + (mapFitViewport.y * latDegreesPerPixel), 180)
        south = Math.max(south - ((map.height - mapFitViewport.bottom) * latDegreesPerPixel), 0)
78 79 80 81 82 83 84 85
        west  = Math.max(west  - (mapFitViewport.x * lonDegreesPerPixel), 0)
        east  = Math.min(east  + ((map.width - mapFitViewport.right) * lonDegreesPerPixel), 360)

        // Back off on zoom level
        east  = Math.min(east  * 1.0000075, 360)
        north = Math.min(north * 1.0000075, 180)
        west  = west  * 0.9999925
        south = south * 0.9999925
86

Gus Grubba's avatar
Gus Grubba committed
87
        // Fit the map region to the new bounding rect
88
        var topLeftCoord      = QtPositioning.coordinate(north - 90.0, west - 180.0)
89 90
        var bottomRightCoord  = QtPositioning.coordinate(south - 90.0, east - 180.0)
        map.setVisibleRegion(QtPositioning.rectangle(topLeftCoord, bottomRightCoord))
91

92 93 94
    }

    function addMissionItemCoordsForFit(coordList) {
95
        for (var i = 1; i < _missionController.visualItems.count; i++) {
96
            var missionItem = _missionController.visualItems.get(i)
97
            if (missionItem.specifiesCoordinate && !missionItem.isStandaloneCoordinate) {
98 99 100 101 102 103
                if(missionItem.boundingCube.isValid()) {
                    coordList.push(missionItem.boundingCube.pointNW)
                    coordList.push(missionItem.boundingCube.pointSE)
                } else {
                    coordList.push(missionItem.coordinate)
                }
104 105 106 107 108
            }
        }
    }

    function fitMapViewportToMissionItems() {
109
        if (!_missionController.visualItems) {
110 111 112
            // Being called prior to controller.start
            return
        }
113 114 115 116 117 118 119 120 121 122 123 124 125
        /*
        for (var i=1; i<_missionController.visualItems.count; i++) {
            var missionItem = _missionController.visualItems.get(i)
            if (missionItem.specifiesCoordinate && !missionItem.isStandaloneCoordinate) {
                console.log(missionItem.boundingCube.pointNW)
                console.log(missionItem.boundingCube.pointSE)
                var loc = QtPositioning.rectangle(missionItem.boundingCube.pointNW, missionItem.boundingCube.pointSE)
                console.log(loc)
                map.visibleRegion = loc
                return
            }
        }
        */
126 127 128 129 130 131
        var coordList = [ ]
        addMissionItemCoordsForFit(coordList)
        fitMapViewportToAllCoordinates(coordList)
    }

    function addFenceItemCoordsForFit(coordList) {
132
        var i
133
        var homePosition = fitHomePosition()
134
        if (homePosition.isValid && _geoFenceController.circleEnabled) {
135
            var azimuthList = [ 0, 180, 90, 270 ]
136
            for (i = 0; i < azimuthList.length; i++) {
137
                var edgeCoordinate = homePosition.atDistanceAndAzimuth(_geoFenceController.circleRadius, azimuthList[i])
138 139 140
                coordList.push(edgeCoordinate)
            }
        }
141
        if (_geoFenceController.polygonEnabled && _geoFenceController.mapPolygon.path.count > 2) {
142
            for (i = 0; i < _geoFenceController.mapPolygon.path.count; i++) {
143
                coordList.push(_geoFenceController.mapPolygon.path[i])
144 145 146 147 148 149 150 151 152 153 154
            }
        }
    }

    function fitMapViewportToFenceItems() {
        var coordList = [ ]
        addFenceItemCoordsForFit(coordList)
        fitMapViewportToAllCoordinates(coordList)
    }

    function addRallyItemCoordsForFit(coordList) {
155 156
        for (var i=0; i<_rallyPointController.points.count; i++) {
            coordList.push(_rallyPointController.points.get(i).coordinate)
157 158 159 160 161 162 163 164 165 166
        }
    }

    function fitMapViewportToRallyItems() {
        var coordList = [ ]
        addRallyItemCoordsForFit(coordList)
        fitMapViewportToAllCoordinates(coordList)
    }

    function fitMapViewportToAllItems() {
167
        if (!_missionController.visualItems) {
168 169 170
            // Being called prior to controller.start
            return
        }
171 172 173 174 175 176 177
        var coordList = [ ]
        addMissionItemCoordsForFit(coordList)
        addFenceItemCoordsForFit(coordList)
        addRallyItemCoordsForFit(coordList)
        fitMapViewportToAllCoordinates(coordList)
    }
} // Item