astar.py

from queue import PriorityQueue
import math
import pygame
import instructions

WIDTH = 600
WIN = pygame.display.set_mode((WIDTH, WIDTH))
pygame.display.set_caption("A* Path Finder")
icon = pygame.image.load("icon.png")
pygame.display.set_icon(icon)

RED = (255, 0, 0)
GREEN = (0, 200, 0)
# BLUE = (106, 106, 255)
BLUE = (62, 153, 255)
LIGHT_BLUE = (162, 162, 255)
YELLOW = (255, 254, 106)
WHITE = (255, 255, 255)
BLACK = (12, 53, 71)
ORANGE = (255, 165, 0)
GREY = (128, 128, 128)

class Spot:
	def __init__(self, row, col, width, total_rows):
		self.row = row
		self.col = col
		self.x = row * width
		self.y = col * width
		self.color = WHITE
		self.neighbors = []
		self.width = width
		self.total_rows = total_rows

	def get_pos(self):
		return self.row, self.col

	def is_closed(self):
		return self.color == LIGHT_BLUE

	def is_open(self):
		return self.color == BLUE

	def is_barrier(self):
		return self.color == BLACK

	def is_start(self):
		return self.color == ORANGE

	def is_end(self):
		return self.color == GREEN

	def reset(self):
		self.color = WHITE

	def make_start(self):
		self.color = ORANGE

	def make_closed(self):
		self.color = LIGHT_BLUE

	def make_open(self):
		self.color = BLUE

	def make_barrier(self):
		self.color = BLACK

	def make_end(self):
		self.color = GREEN

	def make_path(self):
		self.color = YELLOW

	def draw(self, win):
		pygame.draw.rect(win, self.color, (self.x, self.y, self.width, self.width))

	def update_neighbors(self, grid):
		self.neighbors = []
		if self.row < self.total_rows - 1 and not grid[self.row + 1][self.col].is_barrier(): # DOWN
			self.neighbors.append(grid[self.row + 1][self.col])

		if self.row > 0 and not grid[self.row - 1][self.col].is_barrier(): # UP
			self.neighbors.append(grid[self.row - 1][self.col])

		if self.col < self.total_rows - 1 and not grid[self.row][self.col + 1].is_barrier(): # RIGHT
			self.neighbors.append(grid[self.row][self.col + 1])

		if self.col > 0 and not grid[self.row][self.col - 1].is_barrier(): # LEFT
			self.neighbors.append(grid[self.row][self.col - 1])

	def __lt__(self, other): 
		# lt = less than - comparing two objects of same class
		return False


def h(p1, p2):
	x1, y1 = p1
	x2, y2 = p2
	return abs(x1 - x2) + abs(y1 - y2)

def reconstruct_path(came_from, current, start, draw):
	path = []
	while current in came_from:
		current = came_from[current]
		if current != start:
			path.append(current)
	path.reverse()
	for spot in path:
		spot.make_path()
		draw()

def algorithm(draw, grid, start, end):
	count = 0
	open_set = PriorityQueue()
	came_from = {}
	g_score = {spot:float('inf') for row in grid for spot in row}
	g_score[start] = 0
	f_score = {spot:float('inf') for row in grid for spot in row}
	f_score[start] = h(start.get_pos(), end.get_pos())
	open_set.put((f_score[start], count, start))
	open_set_hash = {start}

	while not open_set.empty():
		for event in pygame.event.get():
			if event.type == pygame.QUIT:
				pygame.quit()

		current = open_set.get()[2]
		open_set_hash.remove(current)

		if current == end:
			reconstruct_path(came_from, end, start, draw)
			end.make_end()
			return True

		for neighbor in current.neighbors:
			temp_g_score = g_score[current] + 1

			if temp_g_score < g_score[neighbor]:
				came_from[neighbor] = current
				g_score[neighbor] = temp_g_score
				f_score[neighbor] = temp_g_score + h(neighbor.get_pos(), end.get_pos())
				if neighbor not in open_set_hash:
					count += 1
					open_set.put((f_score[neighbor], count, neighbor))
					open_set_hash.add(neighbor)
					neighbor.make_open()
		draw()

		if current != start:
			current.make_closed()

	return False # Path not found


def make_grid(rows, width):
	grid = []
	size = width // rows
	for i in range(rows):
		grid.append([])
		for j in range(rows):
			spot = Spot(i, j, size, rows)
			grid[i].append(spot)
	return grid

def draw_grid(win, rows, width):
	gap = width//rows
	for i in range(rows):
		pygame.draw.line(win, GREY, (0,i * gap), (width, i * gap))
		for j in range(rows):
			pygame.draw.line(win, GREY, (j * gap, 0), (j * gap, width))

def draw(win, grid, rows, width):
	# Set up the blank background
	win.fill(WHITE)
	# Redraw the spots
	for row in grid:
		for spot in row:
			spot.draw(win)
	# Draw gridlines
	draw_grid(win, rows, width)
	pygame.display.update()

# Translate mouse position to row col position
def get_clicked_pos(pos, rows, width):
	gap = width // rows
	y, x = pos
	row = y // gap
	col = x // gap
	return row, col

def update_grid(grid, rows):
	for row in grid:
		for spot in row:
			color = spot.color
			if color == ORANGE or color == BLACK or color == GREEN:
				continue
			else:
				spot.color = WHITE
	return grid


def main(win, width):
	ROWS = 50 # Change this to get more/less grids
	INSTRUCT = 0
	grid = make_grid(ROWS, width)

	start = None
	end = None

	run = True
	started = False

	while run:
		draw(win, grid, ROWS, width)
		if INSTRUCT == 0:
			instructions.instruct()
			INSTRUCT = 1
		for event in pygame.event.get():
			if event.type == pygame.QUIT:
				run = False

			if pygame.mouse.get_pressed()[0]: # LEFT
				pos = pygame.mouse.get_pos()
				row, col = get_clicked_pos(pos, ROWS, width)
				spot = grid[row][col]
				if not start and spot != end:
					start = spot
					start.make_start()

				elif not end and spot != start:
					end = spot
					end.make_end()

				elif spot != end and spot != start:
					spot.make_barrier()


			elif pygame.mouse.get_pressed()[2]: # RIGHT
				pos = pygame.mouse.get_pos()
				row, col = get_clicked_pos(pos, ROWS, width)
				spot = grid[row][col]
				spot.reset()
				if spot == start:
					start = None
				elif spot == end:
					end = None

			if event.type == pygame.KEYDOWN:
				if event.key == pygame.K_SPACE and start and end:
					for row in grid:
						for spot in row:
							spot.update_neighbors(grid)
					grid = update_grid(grid, ROWS)
					algorithm(lambda : draw(win, grid, ROWS, width), grid, start, end)

				if event.key == pygame.K_c:
					start, end = None, None
					grid = make_grid(ROWS, width)

	pygame.quit()

main(WIN, WIDTH)