s450737/SI-projekt-smieciarka
2
0
Fork 0
Code Issues Pull Requests 1 Projects Releases Wiki Activity

.

Browse Source 
.
This commit is contained in:
ddamiankowalski 2022-04-07 23:32:39 +02:00
parent 73a5d67d39
commit a920f446b5
1 changed files with 112 additions and 69 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

181
board
View File

@ -5,69 +5,76 @@ from queue import Queue
import sys import sys
from unicodedata import name from unicodedata import name
import pygame import pygame
import random
import time
screen = [] screen = []
objectArray = [] objectArray = []
pathToPrint = [] pathToPrint = []
class Object: class Object:
def __init__(self, name, xPos, yPos): def __init__(self, name, xPos, yPos):
self.name = name self.name = name
self.xPos = xPos self.xPos = xPos
self.yPos = yPos self.yPos = yPos
class Field: class Field:
def __init__(self, xPos, yPos): def __init__(self, xPos, yPos, isObject):
self.xPos = xPos self.xPos = xPos
self.yPos = yPos self.yPos = yPos
self.visited = False self.visited = False
self.parent = None self.parent = None
number = random.randint(0, 9)
if number > 7 and not isObject:
self.isBlock = True
else:
self.isBlock = False
def printXandY(self): def printXandY(self):
print("X: " + str(self.xPos) + ". Y: " + str(self.yPos)) print("X: " + str(self.xPos) + ". Y: " + str(self.yPos))
def draw(square_num, objectArr):
#następne dwie linijki do odkomentowania, jak będzie wgrane zdjęcie do tła
#background = pygame.image.load("ścieżka do pliku").convert() #tu ścieżka do zdjęcia w tle
#screen.blit(background, (0, 0))
grid_color = (0, 0, 0) #kolor czarny
grid_size = 500 #rozmiar kraty
square = grid_size/square_num #rozmiar pojedyńczego kwadracika
def draw(square_num, objectArr, pathToTarget, num):
grid_color = (0, 0, 0)
grid_size = 500
square = grid_size/square_num
a = 50 a = 50
b = 10 #odległości kraty od krawędzi okna b = 10
for i in range(square_num): for i in range(square_num):
pygame.draw.line(screen, grid_color, (a + i*square, b), (a + i*square, b + grid_size), 2) pygame.draw.line(screen, grid_color, (a + i*square, b),
(a + i*square, b + grid_size), 2)
pygame.draw.line(screen, grid_color, (a, b + i*square), (a + grid_size, b + i*square), 2) pygame.draw.line(screen, grid_color, (a, b + i*square),
(a + grid_size, b + i*square), 2)
pygame.draw.line(screen, grid_color, (a, b + grid_size), (a + grid_size, pygame.draw.line(screen, grid_color, (a, b + grid_size), (a + grid_size,
b + grid_size), 2) b + grid_size), 2)
pygame.draw.line(screen, grid_color, (a + grid_size, b), pygame.draw.line(screen, grid_color, (a + grid_size, b),
(a + grid_size, b + grid_size), 2) (a + grid_size, b + grid_size), 2)
## tutaj rysujemy agenta i inne obiekty juz na gotowej mapie circleX = objectArr[0].xPos * square + square + square / 2
circleY = objectArr[0].yPos * square + square / 2
a = (10 + circleX, 5 + circleY)
b = (20 + circleX, 5 + circleY)
c = (15 + circleX, 20 + circleY)
polygon = pygame.draw.polygon(screen, (0, 0, 255), (b, a, c))
print(polygon)
## RYSUJEMY AGENTA
#agent_color = (255, 0, 0)
circleX = objectArr[0].xPos * square + square + square/ 2 #dodane jedno +square, by śmieciara nie wychodziła poza kratę
circleY = objectArr[0].yPos * square - square / 2
#radius = 10
#pygame.draw.circle(screen, agent_color, (a + circleX, b + circleY), radius)
# truck = pygame.image.load("car.png").convert_alpha() #tu ścieżka do zdjęcia w tle
# truck = pygame.transform.scale(truck, (square, square))
# screen.blit(truck, (circleX, circleY))
pygame.draw.polygon(screen, (0, 0, 255), [(10 + circleX, 5 + circleY),(20 + circleX, 5 + circleY),(15 + circleX, 20 + circleY)])
circleX = objectArray[1].xPos * square + square
circleY = objectArr[1].yPos * square
circleX = objectArray[1].xPos * square + square * 2
circleY = objectArr[1].yPos * square + square
radius = 8 radius = 8
grid_color = (255, 0, 0) grid_color = (255, 0, 0)
pygame.draw.circle(screen, grid_color, (circleX, circleY), radius) pygame.draw.circle(screen, grid_color, (circleX, circleY), radius)
def kb_listen(objectArray, gridLength): def kb_listen(objectArray, gridLength):
for event in pygame.event.get(): for event in pygame.event.get():
if event.type == pygame.KEYDOWN: if event.type == pygame.KEYDOWN:
@ -77,15 +84,16 @@ def kb_listen(objectArray, gridLength):
if event.key == pygame.K_RIGHT and objectArray[0].xPos < gridLength - 1: if event.key == pygame.K_RIGHT and objectArray[0].xPos < gridLength - 1:
objectArray[0].xPos = objectArray[0].xPos + 1 objectArray[0].xPos = objectArray[0].xPos + 1
print(objectArray[0].xPos) print(objectArray[0].xPos)
if event.key == pygame.K_UP and objectArray[0].yPos > 1: if event.key == pygame.K_UP and objectArray[0].yPos > 0:
objectArray[0].yPos = objectArray[0].yPos - 1 objectArray[0].yPos = objectArray[0].yPos - 1
print(objectArray[0].yPos) print(objectArray[0].yPos)
if event.key == pygame.K_DOWN and objectArray[0].yPos < gridLength: if event.key == pygame.K_DOWN and objectArray[0].yPos < gridLength - 1:
objectArray[0].yPos = objectArray[0].yPos + 1 objectArray[0].yPos = objectArray[0].yPos + 1
print(objectArray[0].yPos) print(objectArray[0].yPos)
if event.type == pygame.QUIT: if event.type == pygame.QUIT:
sys.exit() sys.exit()
fieldQueue = [] fieldQueue = []
isGoalAchieved = False isGoalAchieved = False
@ -97,88 +105,115 @@ def startQueue(agentX, agentY, fieldList, gridNum):
fieldQueue.append(fieldList[currentIndex]) fieldQueue.append(fieldList[currentIndex])
checkFlag = False checkFlag = False
while not checkFlag: while not checkFlag:
result = checkGoal(fieldList, gridNum) result = checkGoal(fieldList, gridNum)
if result: if result:
checkFlag = True checkFlag = True
# print("NEXT CHECK GOAL") # print("NEXT CHECK GOAL")
return result return result
def checkGoal(fieldList, gridNum): def checkGoal(fieldList, gridNum):
currentField = fieldQueue.pop(0) currentField = fieldQueue.pop(0)
currentY = currentField.yPos currentY = currentField.yPos
currentX = currentField.xPos currentX = currentField.xPos
currentIndex = currentY * gridNum + currentX currentIndex = currentY * gridNum + currentX
# print("POPPED!!!") # print("POPPED!!!")
# currentField.printXandY() # currentField.printXandY()
##print(str(currentField.xPos) + " " + str(objectArray[1].xPos) + " " + str(currentField.yPos) + " " + str(objectArray[1].yPos)) ##print(str(currentField.xPos) + " " + str(objectArray[1].xPos) + " " + str(currentField.yPos) + " " + str(objectArray[1].yPos))
## SPRAWDZAMY CZY DANE POLE JEST POLEM W KTORYM ZNAJDUJE SIE NASZ CEL # SPRAWDZAMY CZY DANE POLE JEST POLEM W KTORYM ZNAJDUJE SIE NASZ CEL
if currentField.xPos == objectArray[1].xPos - 1 and currentField.yPos == objectArray[1].yPos - 1: if currentField.xPos == objectArray[1].xPos and currentField.yPos == objectArray[1].yPos:
return currentField return currentField
## SPRAWDZAMY CZY DANE POLE ZOSTALO JUZ WCZESNIEJ ODWIEDZONE - JEZELI NIE TO USTAWIAMY STATUS # SPRAWDZAMY CZY DANE POLE ZOSTALO JUZ WCZESNIEJ ODWIEDZONE - JEZELI NIE TO USTAWIAMY STATUS
if not currentField.visited: if not currentField.visited:
currentField.visited = True currentField.visited = True
## JEZELI DANE POLE NIE ZOSTALO ODWIEDZONE, TO DODAJEMY DO KOLEJKI WSZYSTKIE POLA OBOK I LECIMY DALEJ # JEZELI DANE POLE NIE ZOSTALO ODWIEDZONE, TO DODAJEMY DO KOLEJKI WSZYSTKIE POLA OBOK I LECIMY DALEJ
if currentIndex + 15 <= 224 and fieldList[currentIndex + 15].visited == False: if currentIndex + 15 <= 224 and fieldList[currentIndex + 15].visited == False and fieldList[currentIndex + 15].isBlock == False:
fieldQueue.append(fieldList[currentIndex + 15]) fieldQueue.append(fieldList[currentIndex + 15])
fieldList[currentIndex + 15].parent = fieldList[currentIndex] fieldList[currentIndex + 15].parent = fieldList[currentIndex]
# print("APPENDED DOWN!!!") # print("APPENDED DOWN!!!")
# fieldList[currentIndex + 15].printXandY() # fieldList[currentIndex + 15].printXandY()
if currentIndex - 15 > -1 and fieldList[currentIndex - 15].visited == False: if currentIndex - 15 > -1 and fieldList[currentIndex - 15].visited == False and fieldList[currentIndex - 15].isBlock == False:
fieldQueue.append(fieldList[currentIndex - 15]) fieldQueue.append(fieldList[currentIndex - 15])
fieldList[currentIndex - 15].parent = fieldList[currentIndex] fieldList[currentIndex - 15].parent = fieldList[currentIndex]
# print("APPENDED UP!!!") # print("APPENDED UP!!!")
# fieldList[currentIndex - 15].printXandY() # fieldList[currentIndex - 15].printXandY()
if (currentIndex + 1) % 15 != 0 and fieldList[currentIndex + 1].visited == False: if (currentIndex + 1) % 15 != 0 and fieldList[currentIndex + 1].visited == False and fieldList[currentIndex + 1].isBlock == False:
fieldQueue.append(fieldList[currentIndex + 1]) fieldQueue.append(fieldList[currentIndex + 1])
fieldList[currentIndex + 1].parent = fieldList[currentIndex] fieldList[currentIndex + 1].parent = fieldList[currentIndex]
# print("APPENDED RIGHT!!!") # print("APPENDED RIGHT!!!")
# fieldList[currentIndex + 1].printXandY() # fieldList[currentIndex + 1].printXandY()
if (currentIndex - 1) % 15 != 14 and not currentIndex - 1 < 0 and fieldList[currentIndex - 1].visited == False: if (currentIndex - 1) % 15 != 14 and not currentIndex - 1 < 0 and fieldList[currentIndex - 1].visited == False and fieldList[currentIndex - 1].isBlock == False:
fieldQueue.append(fieldList[currentIndex - 1]) fieldQueue.append(fieldList[currentIndex - 1])
fieldList[currentIndex - 1].parent = fieldList[currentIndex] fieldList[currentIndex - 1].parent = fieldList[currentIndex]
# print("APPENDED LEFT!!!") # print("APPENDED LEFT!!!")
# fieldList[currentIndex - 1].printXandY() # fieldList[currentIndex - 1].printXandY()
if __name__ == '__main__': def generateStartEndPos():
pygame.init() #inicjalizacja modułów, na razie niepotrzebna startX = random.randint(0, 14)
startY = random.randint(0, 14)
print(startX)
targetX = None
targetY = None
#Tworzymy nowego playera, czy tam agenta while targetX == None and targetY == None or targetX == startX and targetY == startY:
agent = Object("smieciarka", 5, 6) targetX = random.randint(0, 14)
target = Object("cel", 1, 2) targetY = random.randint(0, 14)
objectArray.append(agent)
objectArray.append(target) return [startX, startY, targetX, targetY]
if __name__ == '__main__':
pygame.init() # inicjalizacja modułów, na razie niepotrzebna
width = 600 width = 600
height = 530 height = 530
screen = pygame.display.set_mode((width, height)) #ustalanie rozmiarów okna screen = pygame.display.set_mode(
(width, height)) # ustalanie rozmiarów okna
## OBLICZANIE SCIEZKI
# OBLICZANIE RANDOMOWYCH POL START I END
## GENEROWANIE WSZYSTKICH POL - FIELDS [sX, sY, eX, eY] = generateStartEndPos()
print(sX)
print(sY)
print(sX)
print(eY)
# GENEROWANIE WSZYSTKICH POL - FIELDS
fields = [] fields = []
for y in range(15): for y in range(15):
for x in range(15): for x in range(15):
newField = Field(x, y) if x == sX and y == sY or x == eX and y == eY:
newField = Field(x, y, True)
else:
newField = Field(x, y, False)
# newField.printXandY() # newField.printXandY()
fields.append(newField) fields.append(newField)
result = startQueue(objectArray[0].xPos - 1, objectArray[0].yPos - 1, fields, 15) agent = Object("AGENT", sX, sY)
target = Object("TARGET", eX, eY)
# if fields[agent.getX - 1 *
objectArray.append(agent)
objectArray.append(target)
result = startQueue(objectArray[0].xPos,
objectArray[0].yPos, fields, 15)
print("RED DOT X AND Y POSITION ============================") print("RED DOT X AND Y POSITION ============================")
result.printXandY() print("X: " + str(objectArray[1].xPos) + " Y: " + str(objectArray[1].yPos))
print("TRUCK X AND Y POSITION ============================") print("TRUCK X AND Y POSITION ============================")
print("X: " + str(objectArray[0].xPos) + " Y: " + str(objectArray[0].yPos)) print("X: " + str(objectArray[0].xPos) + " Y: " + str(objectArray[0].yPos))
result_parent = result.parent result_parent = result.parent
currentIndex = (objectArray[0].yPos - 1) * 15 + objectArray[0].xPos - 1 currentIndex = (objectArray[0].yPos) * 15 + objectArray[0].xPos
pathToTarget = deque() pathToTarget = deque()
pathToTarget.appendleft(result) pathToTarget.appendleft(result)
@ -192,16 +227,24 @@ if __name__ == '__main__':
node.printXandY() node.printXandY()
while 1: while 1:
c = (255, 255, 255) #tymczasowy kolor tła - do usunięcia, jak już będzie zdjęcie # tymczasowy kolor tła - do usunięcia, jak już będzie zdjęcie
c = (255, 255, 255)
screen.fill(c) screen.fill(c)
draw(15, objectArray) draw(15, objectArray, pathToTarget, 1)
## TUTAJ RYSUJEMY SCIEZKE # TUTAJ RYSUJEMY SCIEZKE
for node in pathToTarget: for node in pathToTarget:
if node == pathToTarget[-1]: if node == pathToTarget[0] or node == pathToTarget[-1]:
continue continue
green = (0, 255, 0) green = (0, 255, 0)
pygame.draw.circle(screen, green, ((node.xPos + 1) * 500 / 15 + 30, (node.yPos + 1) * 500 / 15), 5) pygame.draw.circle(screen, green, ((node.xPos + 1)
* 500 / 15 + 30, (node.yPos + 1) * 500 / 15), 5)
for node in fields:
## DRAWING BLOCKS
if node.isBlock == True:
black = (0, 0, 0)
pygame.draw.rect(screen, black, pygame.Rect((node.xPos + 1) * 500 / 15 + 30, (node.yPos + 1) * 500 / 15 - 10, 10, 10))
kb_listen(objectArray, 15) kb_listen(objectArray, 15)
pygame.display.update() #by krata pojawiła się w okienku - update powierzchni pygame.display.update() # by krata pojawiła się w okienku - update powierzchni