-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathsnake_667.py
175 lines (149 loc) · 7.13 KB
/
snake_667.py
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
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
from snake import Snake
from constants import *
import math
import pygame
class MyAgent667(Snake):
def __init__(self,body=[(0,0)] , direction=(1,0), name="Agent1"):
super().__init__(body,direction,name=name)
self.path = []
#self.openNodes = []
self.closedNodes = []
self.temp_len_players_positions = None
def pathlen(self,a,b):
distX = abs(a[0]-b[0])
distY = abs(a[1]-b[1])
if distX > 60/2:
distX = 60- distX;
if distY > 40/2:
distY = 40 - distY;
return distX + distY
def add(self,a,b):
return (a[0]+b[0])%60,(a[1]+b[1])%40
def update(self,points=None, mapsize=None, count=None,agent_time=None):
#self.points=points
self.mapsize=mapsize
self.count=count
self.agent_time=agent_time
def updateDirection(self,maze):
begin_time = pygame.time.get_ticks();
temp_len = self.temp_len_players_positions
self.temp_len_players_positions = len(maze.playerpos)
if temp_len != self.temp_len_players_positions:
self.closedNodes = []
self.openNodes = []
olddir=self.direction
position=self.body[0]
complement=[(up,down),(down,up),(right,left),(left,right)]
invaliddir=[x for (x,y) in complement if y==olddir]
validdir=[dir for dir in directions if not ( dir in invaliddir )]
if len(self.body) > len(maze.playerpos):
validdir=[dir for dir in validdir if not (self.add(position,dir) in maze.obstacles or self.add(position,dir) in maze.playerpos)]
else:
# possible enemy positions
enemy_head = [pos for pos in maze.playerpos if pos not in self.body][0]
possible_next_enemy_position = [self.add(enemy_head, dir) for dir in directions]
validdir=[dir for dir in validdir if not (self.add(position,dir) in maze.obstacles or self.add(position,dir) in maze.playerpos or self.add(position,dir) in possible_next_enemy_position)]
olddir= olddir if olddir in validdir or len(validdir)==0 else validdir[0]
shortest=self.pathlen(self.add(position,olddir) , maze.foodpos)
#opponentSnakePos = [pos for pos in maze.playerpos if pos not in self.body]
#if(self.pathlen(opponentSnakePos[0],maze.foodpos) + 10 < shortest):
# self.direction=olddir
"""
if(shortest>25):
for dir in validdir:
newpos=self.add(position,dir)
newlen=self.pathlen(newpos , maze.foodpos)#length in shortest path
if newlen < shortest:
olddir=dir
shortest=newlen
self.direction=olddir
else:
"""
path = self.aa(position, self.direction, maze, begin_time)
dir = path[-1].dir if path and path[-1].dir in validdir else olddir
self.direction = dir # if self.path está por segurança
def aa(self,startPos, startDir, maze, begin_time):
startNode=Node(startPos, dir=startDir)
targetNode=Node(maze.foodpos)
startNode.hCost = self.pathlen((startPos[0],startPos[1]),(targetNode.x,targetNode.y))
openNodes= self.closedNodes if self.closedNodes else []
#closedNodes=[]
openNodes.append(startNode)
#print("BLAAAAA: " + str(openNodes))
while openNodes!=[]:
currentNode = openNodes[0]
for node in openNodes:
if node.fCost() < currentNode.fCost():
currentNode = node
if currentNode in openNodes:
openNodes.remove(currentNode)
self.closedNodes.append(currentNode)
if currentNode == targetNode or (pygame.time.get_ticks() - begin_time > self.agent_time - 0.05):
openNodes.append(currentNode)
return self.retracePath(startNode,currentNode)
for n in self.getNeighbours(currentNode, targetNode, maze):#otimizar
if n not in self.closedNodes and n not in openNodes:
openNodes.append(n)
def retracePath(self,startNode, endNode):
path=[]
currentNode = endNode
while currentNode != startNode:
path.append(currentNode)
#self.openNodes.append(currentNode)
currentNode = currentNode.parent
return path #if path else [startNode]
def getNeighbours(self,node,foodNode,maze):
neighbours = []
validdirs = self.getValidDirs(node,maze)
for dir in validdirs:
coord = self.add((node.x,node.y),dir)
newnode = Node(coord, dir=dir,gCost=node.gCost+1,parent=node)
newnode.hCost = self.pathlen((newnode.x,newnode.y),(foodNode.x,foodNode.y))
neighbours.append(newnode)
for diagDir in self.getValidDirsDiag(node,maze):
coord = self.add((node.x,node.y),diagDir)
if node.dir == up or node.dir == down:
if diagDir == (-1,-1) or diagDir == (-1,1):
dir = left
else:
dir = right
else:
if diagDir == (-1,-1) or diagDir == (1,-1):
dir = up
else:
dir = down
if dir in validdirs:
newnode = Node(coord, dir=dir,gCost=node.gCost+2,parent=node)
newnode.hCost = self.pathlen((newnode.x,newnode.y),(foodNode.x,foodNode.y))
neighbours.append(newnode)
return neighbours
def getValidDirs(self,node,maze):
position=node.get_pos()
dirs = []
complement=[(up,down),(down,up),(right,left),(left,right)]
invaliddir=[x for (x,y) in complement if y==node.dir]
validdir = [dir for dir in directions if not ( dir in invaliddir )]
return [dir for dir in validdir if not self.add(position,dir) in maze.obstacles and not self.add(position,dir) in maze.playerpos and not self.add(position,dir) in self.body] #verificar se não vai contra o corpo
def getValidDirsDiag(self,node,maze):
position=node.get_pos()
diagComplement =[(up,(-1,1)), (up, (1,1)) , (down, (1,-1)), (down, (-1,-1)), (left, (1, 1)), (left, (1, -1)), (right, (-1,1)), (right, (-1, -1))]
diagDirections = [(1,1),(1,-1),(-1,1),(-1,-1)]
invaliddir = [y for (x,y) in diagComplement if x == node.dir]
validdir = [dir for dir in diagDirections if not ( dir in invaliddir )]
return [dir for dir in validdir if not self.add(position,dir) in maze.obstacles and not self.add(position,dir) in maze.playerpos and not self.add(position,dir) in self.body]
class Node:
def __init__(self,coord,dir=(0,0), gCost=0, hCost=0, parent=None):
self.x=coord[0]
self.y=coord[1]
self.dir=dir
self.parent=parent
self.gCost=gCost
self.hCost=hCost
def __str__(self):
return str((self.x,self.y))
def __eq__(self,other):
return self.x==other.x and self.y==other.y
def fCost(self):
return self.hCost+self.gCost
def get_pos(self):
return (self.x, self.y)