443 lines
15 KiB
Python
443 lines
15 KiB
Python
import pygame
|
|
import random
|
|
import time
|
|
import queue
|
|
import math
|
|
|
|
pygame.init()
|
|
|
|
|
|
def heuristic(current, goal):
|
|
dx = abs(current[0] - goal[0])
|
|
dy = abs(current[1] - goal[1])
|
|
return math.sqrt(dx * dx + dy * dy)
|
|
|
|
|
|
class Node():
|
|
def __init__(self, parent = None, position = None):
|
|
self.parent = parent
|
|
self.position = position
|
|
|
|
self.g = 0
|
|
self.h = 0
|
|
self.f = 0
|
|
|
|
def __eq__(self, other):
|
|
return self.position == other.position
|
|
|
|
|
|
def aStar(start, end):
|
|
if end in cantwalk:
|
|
print("Wybrano nieodpowiednie pole!")
|
|
return []
|
|
|
|
start_node = Node(None, start)
|
|
start_node.g = start_node.h = start_node.f = 0
|
|
end_node = Node(None, end)
|
|
end_node.g = end_node.h = end_node.f = 0
|
|
|
|
open_list = []
|
|
closed_list = []
|
|
open_list.append(start_node)
|
|
|
|
while len(open_list) > 0:
|
|
current_node = open_list[0]
|
|
current_index = 0
|
|
for index, item in enumerate(open_list):
|
|
if item.f < current_node.f:
|
|
current_node = item
|
|
current_index = index
|
|
|
|
open_list.pop(current_index)
|
|
closed_list.append(current_node)
|
|
|
|
if current_node == end_node:
|
|
path = []
|
|
current = current_node
|
|
while current is not None:
|
|
path.append(current.position)
|
|
current = current.parent
|
|
return list(map(lambda t: (t[0], t[1]), path[::-1])) #zwraca odwróconą ściezkę
|
|
|
|
children = []
|
|
# można dodać (-1, -1), (-1, 1), (1, -1), (1, 1) dla poruszania się po przekątnej
|
|
for new_position in [(0, -1), (0, 1), (-1, 0), (1, 0)]:
|
|
node_position = (current_node.position[0] + new_position[0], current_node.position[1]
|
|
+ new_position[1])
|
|
|
|
if node_position[0] >= (rows - 1) or node_position[0] <= 0 or node_position[1] >= (rows - 1) \
|
|
or node_position[1] <= 0: #spr. czy w kracie
|
|
continue
|
|
|
|
if node_position in cantwalk: #spr. czy można przejść
|
|
continue
|
|
|
|
new_node = Node(current_node, node_position)
|
|
children.append(new_node)
|
|
|
|
didBreak = False
|
|
for child in children:
|
|
didBreak = False
|
|
for closed_child in closed_list:
|
|
if child == closed_child:
|
|
didBreak = True
|
|
break
|
|
|
|
if didBreak:
|
|
continue
|
|
|
|
if child.position in cantwalk:
|
|
child.g = current_node.g + 99999
|
|
elif child.position in puddles:
|
|
child.g = current_node.g + 3
|
|
else:
|
|
child.g = current_node.g + 1
|
|
|
|
child.h = heuristic(child.position, end_node.position)
|
|
child.f = child.g + child.h
|
|
|
|
for open_node in open_list:
|
|
if child == open_node and child.g > open_node.g:
|
|
didBreak = True
|
|
break
|
|
|
|
if didBreak:
|
|
continue
|
|
|
|
open_list.append(child)
|
|
|
|
|
|
class Dish(object):
|
|
def __init__(self, dishName, prepTime, eatTime, price):
|
|
self.dishName = dishName
|
|
self.preparationTime = prepTime
|
|
self.eatingTime = eatTime
|
|
self.price = price
|
|
|
|
|
|
class Plate(object):
|
|
def __init__(self, dish):
|
|
self.dishName = dish.dishName
|
|
self.isEmpty = False
|
|
self.preparationTime = dish.preparationTime
|
|
self.eatingTime = dish.eatingTime
|
|
self.price = dish.price
|
|
|
|
def eat(self):
|
|
time.sleep(self.eatingTime)
|
|
self.isEmpty = True #zjadanie dania jest oznaczeniem talerza jako pusty (metoda będzie wywoływana przez klienta)
|
|
|
|
|
|
class Kitchen(object):
|
|
def __init__(self, pos):
|
|
self.readyDishes = queue.Queue(32) #kolejka o maksymalnej długości 32
|
|
self.orders = queue.Queue(32) #wyskakiwał mi tu błąd - poprawiłam na dużą literę i jest ok
|
|
self.pos = pos
|
|
|
|
def makeDish(self):
|
|
if not self.orders.empty():
|
|
plate = self.orders.get()
|
|
time.sleep(plate.preparationTime) #kuchnia przygotowuje danie przez określony czas
|
|
self.readyDishes.put(plate)
|
|
|
|
def giveDish(self):
|
|
if not self.readyDishes.empty():
|
|
plate = self.readyDishes.get()
|
|
return plate
|
|
else:
|
|
return None
|
|
|
|
def draw(self, surface):
|
|
image1 = pygame.image.load(r'kitchen1.png')
|
|
image1 = pygame.transform.scale(image1, (sizeBetween - 1, sizeBetween - 1))
|
|
surface.blit(image1, (13*sizeBetween+1, 0*sizeBetween+1))
|
|
|
|
image2 = pygame.image.load(r'kitchen2.png')
|
|
image2 = pygame.transform.scale(image2, (sizeBetween - 1, sizeBetween - 1))
|
|
surface.blit(image2, (14*sizeBetween+1, 0*sizeBetween+1))
|
|
|
|
image3 = pygame.image.load(r'kitchen3.png')
|
|
image3 = pygame.transform.scale(image3, (sizeBetween - 1, sizeBetween - 1))
|
|
surface.blit(image3, (13*sizeBetween+1, 1*sizeBetween+1))
|
|
|
|
image4 = pygame.image.load(r'kitchen4.png')
|
|
image4 = pygame.transform.scale(image4, (sizeBetween - 1, sizeBetween - 1))
|
|
surface.blit(image4, (14*sizeBetween+1, 1*sizeBetween+1))
|
|
|
|
|
|
class Client(object):
|
|
def __init__(self, age, sex, budget):
|
|
self.age = age
|
|
self.sex = sex
|
|
self.myPlate = None
|
|
self.budget = budget
|
|
self.myTable = 0 #domyślnie klient nie siedzi przy żadnym stole
|
|
|
|
def takePlateAndEat(self, plate):
|
|
self.myPlate = plate
|
|
plate.eat()
|
|
|
|
def takeASeat(self, table):
|
|
self.myTable = table
|
|
|
|
|
|
class Table(object):
|
|
def __init__(self, pos, capacity):
|
|
self.pos = pos
|
|
self.capacity = capacity
|
|
|
|
def move(self, newx, newy): #metoda do ustawiania stołów poprzez podanie nowych współrzędnych
|
|
self.pos[0] = newx
|
|
self.pos[1] = newy
|
|
|
|
def draw(self, surface):
|
|
image = pygame.image.load(r'Table-croped.png')
|
|
image = pygame.transform.scale(image, (sizeBetween - 1, sizeBetween - 1))
|
|
|
|
i = self.pos[0]
|
|
j = self.pos[1]
|
|
|
|
surface.blit(image, (i*sizeBetween+1, j*sizeBetween+1))
|
|
|
|
|
|
class Waiter(object):
|
|
def __init__(self, color, pos, direction):
|
|
self.color = color
|
|
self.pos = pos #pozycja agenta, zapisana w formie dwuelementowej listy
|
|
self.posx = pos[0]
|
|
self.posy = pos[1]
|
|
self.dirnx = 0 #zmienne dirnx i dirny używane są do ruchu bota i ustalania, w którą stronę jest zwrócony
|
|
self.dirny = 1
|
|
self.plates = [] #lista niesionych przez agenta talerzy, planowo lista par: (talerz, klient)
|
|
self.direction = direction #kierunek, w ktory jest skierowany bot
|
|
|
|
def moveRandomly(self, noWalkable):
|
|
rand = random.randrange(1, 5, 1) #losuje w zakresie 1-4
|
|
#print(rand)
|
|
|
|
if rand == 1:
|
|
self.dirnx = -1
|
|
self.dirny = 0
|
|
self.direction = 'left'
|
|
if self.pos[0] == 0 or ([self.pos[0] + self.dirnx, self.pos[1] + self.dirny] in noWalkable): #zabezpieczenie przed wyjściem bota poza obszar okna w ruchu losowym
|
|
self.dirnx *= (-1) #oraz w miejsce, na ktore nie moze wejsc (stoły, kuchania)
|
|
self.direction = 'right'
|
|
self.pos = [self.pos[0] + self.dirnx, self.pos[1] + self.dirny]
|
|
|
|
elif rand == 2:
|
|
self.dirnx = 1
|
|
self.dirny = 0
|
|
self.direction = 'right'
|
|
if self.pos[0] == 14 or ([self.pos[0] + self.dirnx, self.pos[1] + self.dirny] in noWalkable):
|
|
self.dirnx *= (-1)
|
|
self.direction = 'left'
|
|
self.pos = [self.pos[0] + self.dirnx, self.pos[1] + self.dirny]
|
|
|
|
elif rand == 3:
|
|
self.dirnx = 0
|
|
self.dirny = -1
|
|
if self.pos[1] == 0 or ([self.pos[0] + self.dirnx, self.pos[1] + self.dirny] in noWalkable):
|
|
self.dirny *= (-1)
|
|
self.pos = [self.pos[0] + self.dirnx, self.pos[1] + self.dirny]
|
|
|
|
elif rand == 4:
|
|
self.dirnx = 0
|
|
self.dirny = 1
|
|
if self.pos[1] == 14 or ([self.pos[0] + self.dirnx, self.pos[1] + self.dirny] in noWalkable):
|
|
self.dirny *= (-1)
|
|
self.pos = [self.pos[0] + self.dirnx, self.pos[1] + self.dirny]
|
|
|
|
def moveWithKeyboard(self, noWalkable): #funkcja testowa - bot sterowany z klawiatury
|
|
for event in pygame.event.get():
|
|
if event.type == pygame.QUIT:
|
|
pygame.quit()
|
|
quit()
|
|
|
|
keys = pygame.key.get_pressed()
|
|
|
|
for key in keys:
|
|
if keys[pygame.K_LEFT]:
|
|
self.dirnx = -1
|
|
self.dirny = 0
|
|
self.direction = 'left'
|
|
if self.pos[0] == 0 or ([self.pos[0] + self.dirnx, self.pos[1] + self.dirny] in noWalkable): # zabezpieczenie przed wyjściem bota poza obszar okna w ruchu losowym
|
|
#self.dirnx *= (-1)
|
|
break
|
|
else:
|
|
self.pos = [self.pos[0] + self.dirnx, self.pos[1] + self.dirny]
|
|
break
|
|
# te break musiałam dodać, bo w przeciwnym wypadku zamiast jednego kroku robił 303 - jeden za drugim
|
|
# nie wiem dlaczego tak było, po zmianie sterowania z klawiatury na bota samego w sobie nie powinno
|
|
# być z tym problemów, to jest na razie tylko, żeby pokazać, że ten ruch jest
|
|
|
|
elif keys[pygame.K_RIGHT]:
|
|
self.dirnx = 1
|
|
self.dirny = 0
|
|
self.direction = 'right'
|
|
if self.pos[0] == 14 or ([self.pos[0] + self.dirnx, self.pos[1] + self.dirny] in noWalkable):
|
|
#self.dirnx *= (-1)
|
|
break
|
|
else:
|
|
self.pos = [self.pos[0] + self.dirnx, self.pos[1] + self.dirny]
|
|
break
|
|
|
|
elif keys[pygame.K_UP]:
|
|
self.dirnx = 0
|
|
self.dirny = -1
|
|
if self.pos[1] == 0 or ([self.pos[0] + self.dirnx, self.pos[1] + self.dirny] in noWalkable):
|
|
#self.dirny *= (-1)
|
|
break
|
|
else:
|
|
self.pos = [self.pos[0] + self.dirnx, self.pos[1] + self.dirny]
|
|
break
|
|
|
|
elif keys[pygame.K_DOWN]:
|
|
self.dirnx = 0
|
|
self.dirny = 1
|
|
if self.pos[1] == 14 or ([self.pos[0] + self.dirnx, self.pos[1] + self.dirny] in noWalkable):
|
|
#self.dirny *= (-1)
|
|
break
|
|
else:
|
|
self.pos = [self.pos[0] + self.dirnx, self.pos[1] + self.dirny]
|
|
break
|
|
|
|
def resetPosition(self, pos):
|
|
self.pos = pos
|
|
|
|
def takePlates(self, kitchen):
|
|
for i in range(2):
|
|
plate = kitchen.giveDish()
|
|
if plate == None:
|
|
break
|
|
else:
|
|
self.plates.append(plate)
|
|
|
|
def giveClientPlate(self, client):
|
|
plate = self.plates.pop(0)
|
|
client.takePlateAndEat(plate)
|
|
|
|
def draw(self, surface):
|
|
image = pygame.image.load(r'waiter_right.png')
|
|
image = pygame.transform.scale(image, (sizeBetween - 1, sizeBetween - 1))
|
|
|
|
if self.direction == "right":
|
|
image = pygame.transform.rotate(image, 270)
|
|
elif self.direction == "left":
|
|
image = pygame.transform.rotate(image, 90)
|
|
elif self.direction == "up":
|
|
image = pygame.transform.rotate(image, 180)
|
|
|
|
i = self.pos[0]
|
|
j = self.pos[1]
|
|
surface.blit(image, (i * sizeBetween + 1, j * sizeBetween + 1))
|
|
|
|
def goByAStar(self, end):
|
|
positionList = aStar(self.pos, end)
|
|
print(positionList)
|
|
lenght = len(positionList) - 1
|
|
for i in range(lenght):
|
|
movex = positionList[i + 1][0] - positionList[i][0]
|
|
movey = positionList[i + 1][1] - positionList[i][1]
|
|
self.posx += movex
|
|
self.posy += movey
|
|
self.pos = (self.posx, self.posy)
|
|
|
|
if movex == -1 and movey == 0:
|
|
self.direction = "left"
|
|
elif movex == 1 and movey == 0:
|
|
self.direction = "right"
|
|
elif movey == -1 and movex == 0:
|
|
self.direction = "down"
|
|
else:
|
|
self.direction = "up"
|
|
|
|
redrawWindow(window)
|
|
time.sleep(0.5)
|
|
|
|
|
|
def drawGrid(width, rows, surface):
|
|
x = 0
|
|
y = 0
|
|
|
|
for i in range(rows):
|
|
x = x + sizeBetween
|
|
y = y + sizeBetween
|
|
|
|
pygame.draw.line(surface, (255, 255, 255), (x, 0), (x, width))
|
|
pygame.draw.line(surface, (255, 255, 255), (0, y), (width, y))
|
|
|
|
|
|
def redrawWindow(surface):
|
|
surface.fill(beige)
|
|
bot.draw(surface)
|
|
kitchen.draw(surface)
|
|
for i in range(len(tables)):
|
|
tables[i].draw(surface)
|
|
for i in range(len(puddles)):
|
|
image = pygame.image.load(r'puddle.png')
|
|
image = pygame.transform.scale(image, (sizeBetween - 1, sizeBetween - 1))
|
|
surface.blit(image, (puddles[i][0]* sizeBetween + 1, puddles[i][1]* sizeBetween + 1))
|
|
drawGrid(width, rows, surface)
|
|
pygame.display.update()
|
|
|
|
def noWalkable(tables, kitchen):
|
|
list = []
|
|
for i in range(len(tables)):
|
|
list.append(tables[i].pos)
|
|
list.append(kitchen.pos)
|
|
return list
|
|
|
|
def main():
|
|
global width, rows, bot, beige, white, black, sizeBetween, tables, kitchen, cantwalk, puddles, window
|
|
# skróty do kolorów
|
|
beige = (255, 205, 178)
|
|
white = (255, 255, 255)
|
|
black = (0, 0, 0)
|
|
|
|
width = 600
|
|
rows = 15
|
|
sizeBetween = width // rows #wielkość pojedynczej kratki
|
|
window = pygame.display.set_mode((width, width))
|
|
bot = Waiter((255, 0, 0), (12, 8), "right")
|
|
|
|
tables = []
|
|
tables.append(Table((0, 3), 1))
|
|
tables.append(Table((0, 6), 1))
|
|
tables.append(Table((0, 9), 2))
|
|
tables.append(Table((0, 12), 2))
|
|
tables.append(Table((4, 4), 2))
|
|
tables.append(Table((4, 7), 2))
|
|
tables.append(Table((4, 10), 2))
|
|
tables.append(Table((4, 13), 2))
|
|
tables.append(Table((8, 3), 1))
|
|
tables.append(Table((8, 6), 1))
|
|
tables.append(Table((8, 9), 2))
|
|
tables.append(Table((8, 12), 2))
|
|
|
|
flag = True
|
|
clock = pygame.time.Clock()
|
|
kitchen = Kitchen((13, 1))
|
|
|
|
cantwalk = noWalkable(tables, kitchen) # lista pozycji, na ktore bot nie moze wejsc
|
|
puddles = []
|
|
puddles.append((7, 10))
|
|
puddles.append((2, 5))
|
|
puddles.append((3, 12))
|
|
puddles.append((10, 3))
|
|
puddles.append((6, 2))
|
|
puddles.append((12, 10))
|
|
puddles.append((1, 4))
|
|
|
|
while flag:
|
|
pygame.time.delay(100)
|
|
clock.tick(60)
|
|
redrawWindow(window)
|
|
#bot.moveRandomly(list)
|
|
goal = (1,5)
|
|
bot.goByAStar(goal)
|
|
time.sleep(120)
|
|
flag = False
|
|
|
|
|
|
main()
|