-
Notifications
You must be signed in to change notification settings - Fork 1
Expand file tree
/
Copy pathk_dimensions_tree.rb
More file actions
145 lines (131 loc) · 4.21 KB
/
k_dimensions_tree.rb
File metadata and controls
145 lines (131 loc) · 4.21 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
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
class KDTree
attr_accessor :root, :points_in_rectangle, :min_distance, :min_point
def initialize
@root = nil
@points_in_rectangle = []
@min_distance = nil
@min_point = nil
end
def insertion(point)
current = @root
@root = insert(current, point)
end
def insert(current, point, level=0)
x, y = point
if !current
return Point.new(x, y)
end
if level.even?
if x < current.x
current.left = insert(current.left, point, level+1)
else
current.right = insert(current.right, point, level+1)
end
elsif level.odd?
if y < current.y
current.left = insert(current.left, point, level+1)
else
current.right = insert(current.right, point, level+1)
end
end
return current
end
def get_points_in(lb, rt)
query_rectangle(lb, rt)
answer = @points_in_rectangle
@points_in_rectangle = []
return answer
end
def query_rectangle(lb, rt, level=0, current=@root)
return if !current
lbx, lby = lb
rtx, rty = rt
if level.even?
if rtx < current.x
query_rectangle(lb, rt, level+1, current.left)
elsif lbx > current.x
query_rectangle(lb, rt, level+1, current.right)
else
if current.y <= rty && current.y >= lby
@points_in_rectangle << [current.x, current.y]
end
query_rectangle(lb, rt, level+1, current.left)
query_rectangle(lb, rt, level+1, current.right)
end
elsif level.odd?
if rty < current.y
query_rectangle(lb, rt, level+1, current.left)
elsif lby > current.y
query_rectangle(lb, rt, level+1, current.right)
else
if current.x <= rtx && current.x >= lbx
@points_in_rectangle << [current.x, current.y]
end
query_rectangle(lb, rt, level+1, current.left)
query_rectangle(lb, rt, level+1, current.right)
end
end
end
def distance(p1, p2)
Math.sqrt((p2[1]-p1[1])**2 + (p2[0]-p1[0])**2)
end
def mini_x(dest, test)
(dest[0] - test[0]).abs
end
def mini_y(dest, test)
(dest[1] - test[1]).abs
end
def get_closest(point)
closest(point)
answer = @min_point
@min_point = nil
@min_distance = nil
return answer
end
def closest(point, current=@root, level=0)
return if !current
x, y = point
if !@min_distance || @min_distance > distance(point, [current.x, current.y])
@min_distance = distance(point, [current.x, current.y])
@min_point = [current.x, current.y]
end
if level.even?
if x < current.x
closest(point, current.left, level+1)
closest(point, current.right, level+1) if mini_x(point, [current.x,current.y]) < @min_distance
else
closest(point, current.right, level+1)
closest(point, current.left, level+1) if mini_x(point, [current.x, current.y]) < @min_distance
end
elsif level.odd?
if y < current.y
closest(point, current.left, level+1)
closest(point, current.right, level+1) if mini_y(point, [current.x,current.y]) < @min_distance
else
closest(point, current.right, level+1)
closest(point, current.left, level+1) if mini_y(point, [current.x, current.y]) < @min_distance
end
end
end
end
class Point
attr_accessor :left, :right, :x, :y
def initialize(x,y)
@x = x
@y = y
@left = nil
@right = nil
end
end
kdtree = KDTree.new
kdtree.insertion([1,2])
kdtree.insertion([3,4])
kdtree.insertion([-1,-2])
kdtree.insertion([5,6])
kdtree.insertion([6,7])
kdtree.insertion([7,8])
kdtree.insertion([8,9])
kdtree.insertion([9,10])
p kdtree.get_points_in([-10,-10], [10,10])
p kdtree.get_closest([1000,1000])
p kdtree.root