structure.py
2.71 KB
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
from operator import itemgetter as ig
class RSSVector():
distances = []
def __init__(self, n1, n2, n3, n4):
self.n1 = n1
self.n2 = n2
self.n3 = n3
self.n4 = n4
class Location():
def __init(self):
self.x = self.y = self.z = 0
def __init__(self, x, y, z=0):
self.x = x
self.y = y
self.z = z
def __mul__(self, multiplier):
returnValue = Location(self.x, self.y, self.z)
returnValue.x *= multiplier
returnValue.y *= multiplier
returnValue.z *= multiplier
return returnValue
def __rmul__(self, multiplier):
return self * multiplier
def __add__(self, added):
returnValue = Location(self.x, self.y, self.z)
returnValue.x += added.x
returnValue.y += added.y
returnValue.z += added.z
return returnValue
def toString(self):
return "(" + str(self.x) + " ; " + str(self.y) + " ; " + str(self.z) + ")"
class Cell():
def __init__(self, v_, loc):
self.v = v_
self.location = loc
self.Likeliness = .0 # Probability of Markov model
self.pastCount = 1
def newCell(n1, n2, n3, n4, l1, l2):
return Cell(RSSVector(n1,n2,n3,n4), Location(l1,l2))
def KNeighbors(fingerprints, sample):
'''
Returns the 4 closest cells to the given sample and fills sample distance data
:param Cell[3][3] fingerprints: 2D array of all the cells
:param RSSIVector sample: Mobile terminal sample
:return Cell[4]: the 4 nearest cells
'''
distances = []
neighbours = []
for row in fingerprints:
for currentItem in row:
dist = abs(currentItem.v.n1 - sample.n1) \
+ abs(currentItem.v.n2 - sample.n2) \
+ abs(currentItem.v.n3 - sample.n3) \
+ abs(currentItem.v.n4 - sample.n4)
distances.append((dist, currentItem))
distances = sorted(distances, key=ig(0))
for k in range (0,4):
neighbours.append(distances[k][1])
sample.distances.append(distances[k][0])
return neighbours
def resolve_barycenter(nC, d):
'''
Returns the weighted barycenter of the 4 neighbouring cells
:param Cell[4] nC: (neighborCells) Array containing the 4 closest cells
:param distance[4] d: distances of the sample of the mobile terminal
:return Location: Estimated location of the mobile terminal (return None if error)
'''
return None if len(nC) != 4 else \
1 / (1+d[0]/d[1]+d[0]/d[2]+d[0]/d[3])*nC[0].location \
+ 1 / (1+d[1]/d[0]+d[1]/d[2]+d[1]/d[3])*nC[1].location \
+ 1 / (1+d[2]/d[1]+d[2]/d[0]+d[2]/d[3])*nC[2].location \
+ 1 / (1+d[3]/d[1]+d[3]/d[2]+d[3]/d[0])*nC[3].location