Merge branch 'master' of https://git.wmi.amu.edu.pl/s434720/2019SZI-Projekt
This commit is contained in:
commit
3b7984bba0
75
UI/Apath.py
Normal file
75
UI/Apath.py
Normal file
@ -0,0 +1,75 @@
|
|||||||
|
import numpy
|
||||||
|
from heapq import * # pylint: disable=unused-wildcard-import
|
||||||
|
|
||||||
|
|
||||||
|
def heuristic(a, b, pathing):
|
||||||
|
|
||||||
|
x = abs(a[0]-b[0])
|
||||||
|
y = abs(a[1]-b[1])
|
||||||
|
|
||||||
|
if pathing == '*':
|
||||||
|
|
||||||
|
if x > y:
|
||||||
|
return 14*y + 10*(x - y)
|
||||||
|
else:
|
||||||
|
return 14*x + 10*(y - x)
|
||||||
|
else:
|
||||||
|
return 10*(x + y)
|
||||||
|
|
||||||
|
|
||||||
|
def astar(array, start, goal, pathing):
|
||||||
|
|
||||||
|
if pathing == '+':
|
||||||
|
neighbors = [(0, 1), (0, -1), (1, 0), (-1, 0)]
|
||||||
|
else:
|
||||||
|
neighbors = [(0, 1), (0, -1), (1, 0), (-1, 0), (1, 1), (1, -1), (-1, 1), (-1, -1)]
|
||||||
|
neighbors = [(i, j)for i in range(-1, 2, 1) for j in range(2)]
|
||||||
|
|
||||||
|
came_from = {}
|
||||||
|
gscore = {start: 0}
|
||||||
|
fscore = {start: heuristic(start, goal, pathing)}
|
||||||
|
oheap = []
|
||||||
|
checked = []
|
||||||
|
|
||||||
|
heappush(oheap, (fscore[start], start))
|
||||||
|
|
||||||
|
while oheap:
|
||||||
|
|
||||||
|
current = heappop(oheap)[1]
|
||||||
|
checked.append(current)
|
||||||
|
|
||||||
|
if current == goal:
|
||||||
|
data = []
|
||||||
|
while current in came_from:
|
||||||
|
data.append(current)
|
||||||
|
current = came_from[current]
|
||||||
|
|
||||||
|
return list(reversed(data)), checked
|
||||||
|
|
||||||
|
array[current[0], current[1]] = 2
|
||||||
|
for i, j in neighbors:
|
||||||
|
|
||||||
|
neighbor = current[0] + i, current[1] + j
|
||||||
|
|
||||||
|
tentative_g_score = gscore[current] + heuristic(current, neighbor, pathing)
|
||||||
|
|
||||||
|
if 0 <= neighbor[0] < array.shape[0]:
|
||||||
|
if 0 <= neighbor[1] < array.shape[1]:
|
||||||
|
if array.flat[array.shape[1] * neighbor[0]+neighbor[1]] == 1:
|
||||||
|
continue
|
||||||
|
else:
|
||||||
|
# array bound y walls
|
||||||
|
continue
|
||||||
|
else:
|
||||||
|
# array bound x walls
|
||||||
|
continue
|
||||||
|
|
||||||
|
if array[neighbor[0]][neighbor[1]] == 2 and tentative_g_score >= gscore.get(neighbor, 0):
|
||||||
|
continue
|
||||||
|
|
||||||
|
if tentative_g_score < gscore.get(neighbor, 0) or neighbor not in [i[1]for i in oheap]:
|
||||||
|
came_from[neighbor] = current
|
||||||
|
gscore[neighbor] = tentative_g_score
|
||||||
|
fscore[neighbor] = tentative_g_score + heuristic(neighbor, goal, pathing)
|
||||||
|
heappush(oheap, (fscore[neighbor], neighbor))
|
||||||
|
return False
|
0
UI/__init__.py
Normal file
0
UI/__init__.py
Normal file
@ -4,7 +4,7 @@ from UI.grid import Grid, Node
|
|||||||
|
|
||||||
class Window():
|
class Window():
|
||||||
def __init__(self, grid: Grid):
|
def __init__(self, grid: Grid):
|
||||||
pg.init()
|
pg.init() # pylint: disable=no-member
|
||||||
# setup window
|
# setup window
|
||||||
pg.display.set_caption('Inteligentna śmieciarka')
|
pg.display.set_caption('Inteligentna śmieciarka')
|
||||||
|
|
||||||
@ -35,4 +35,4 @@ class Window():
|
|||||||
self.grid.draw_node(self.screen, x - 1, y - 1)
|
self.grid.draw_node(self.screen, x - 1, y - 1)
|
||||||
self.grid.draw_node(self.screen, x, y)
|
self.grid.draw_node(self.screen, x, y)
|
||||||
pg.time.delay(500)
|
pg.time.delay(500)
|
||||||
pg.quit()
|
pg.quit() # pylint: disable=no-member
|
||||||
|
Loading…
Reference in New Issue
Block a user