LearningPython/GPSSearchAround.py at master · chenbin11200/LearningPython · GitHub

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
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
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
import numpy as np
from matplotlib import pyplot as plt

import math
from decimal import Decimal

import os
import xml.etree.cElementTree as ET
import time

import Helper
import GPSLocationPointCreatetor

Speed = 5  # m/s
SearchRange = 20  # meter


def startSearching(searchCenter):
    searchMaxRadius = 150
    radius = 20
    eachStepPlusRadius = 0.3

    centerX1 = searchCenter["lat"]
    centerY1 = searchCenter["lng"]

    searchMaxRadius_T = getMaxDeviation(centerX1, searchMaxRadius)["lat"]
    radius_T = getDistanceInLat(centerX1, radius)
    eachStepPlusRadius_T = getDistanceInLat(centerX1, eachStepPlusRadius)
    speed_T = getDistanceInLat(centerX1, Speed)

    startPoint = {"lat": centerX1 + getMaxDeviation(centerX1, radius)["lat"], "lng": centerY1}
    x=[]
    y=[]

    print(centerX1, centerY1)
    print(startPoint["lat"], startPoint["lng"])

    x.append(centerX1)
    y.append(centerY1)
    x.append(startPoint["lat"])
    y.append(startPoint["lng"])
    central_rad = 0

    while radius_T <= searchMaxRadius_T:
        radius_T += getEachStepPlusRadius_T(speed_T, radius_T, getDistanceInLat(centerX1, SearchRange))
        central_rad += speed_T / radius_T
        x2 = radius_T * math.cos(central_rad) + centerX1
        y2 = radius_T * math.sin(central_rad) + centerY1
        GPSLocationPointCreatetor.createGPSFile4IOS(x2, y2)

        startPoint["lat"] = x2
        startPoint["lng"] = y2
        print(x2, y2)
        x.append(x2)
        y.append(y2)

    plt.figure()
    #plt.xlim(0, 100)
    #plt.ylim(0, 30)
    plt.plot(x, y, 'o')
    plt.show()


def getEachStepPlusRadius_T (distance_T, currentRadius_T, searchRangeRadius_T):
    return distance_T/(2*math.pi*currentRadius_T) * searchRangeRadius_T


def rad(angle):
    return angle * math.pi / 180


# http://www.cnblogs.com/zrhai/p/3817492.html
# http://www.ucbbs.org/cgi-bin/bbs/ccb/topic_view.cgi?forum=1&article_id=0101080324231941&class=1
# Calculate max latitude & longitude difference according to a certain latitude and distance(in meter)
# The result is a square area
def getMaxDeviation(lat, distance):
    EARTH_RADIUS = 6377.830  # in km
    radLat = rad(lat)
    latRatio = 180 / (math.pi * EARTH_RADIUS)
    lngRatio = latRatio / math.cos(radLat)
    latDeviation = distance / 1000.0 * latRatio  # in meter
    lngDeviation = distance / 1000.0 * lngRatio # in meter
    return {"lat": latDeviation, "lng": lngDeviation}


def getDistanceInLat(lat, distance):
    lat = getMaxDeviation(lat, distance)["lat"]
    lng = getMaxDeviation(lat, distance)["lng"]
    return math.sqrt(lat*lat + lng*lng)


def test():
    startSearching({"lat": 53.5529891641475, "lng": 9.99261278100636})

test()