-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathmain.py
100 lines (82 loc) · 3.31 KB
/
main.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
import os
from api.new_api import Api
from api.api_recv import Api_recv
import comm
import vision
import match
import argparse
import fields as pitch
from pyVSSSReferee.RefereeComm import RefereeComm
from commons.utils import get_config
parser = argparse.ArgumentParser(description='NeonFC')
parser.add_argument('--config_file', default='config.json')
args = parser.parse_args()
class Game():
def __init__(self, config_file=None):
self.config = get_config(config_file)
self.match = match.Match(self,
**self.config.get('match')
)
self.vision = vision.FiraVision()
self.comm = comm.FiraComm()
self.field = pitch.Field(self.match.category)
self.referee = RefereeComm(config_file)
self.use_api = self.config.get("api")
self.api_address = self.config.get("network").get("api_address")
self.api_port = self.config.get("network").get("api_port")
self.api_recv_port = self.config.get("network").get("api_recv_port")
self.api = Api(self.api_address, self.api_port)
self.api_recv = Api_recv(self.match, self.api_address, self.api_recv_port)
if os.environ.get('USE_REFEREE'):
self.use_referee = bool(int(os.environ.get('USE_REFEREE')))
else:
self.use_referee = self.config.get('referee')
self.start()
def start(self):
self.vision.assign_vision(self)
self.referee.start()
self.match.start()
self.vision.start()
self.comm.start()
if self.use_api:
self.api.start()
self.api_recv.start()
def update(self):
frame = vision.assign_empty_values(
self.vision.frame,
field_size=self.field.get_dimensions(),
team_side=self.match.team_side
)
self.match.update(frame)
commands = self.match.decide()
if self.use_api and self.match.game_status == 'stop':
commands = [
{
'robot_id': r['robot_id'],
'color': r['color'],
'wheel_left': 0,
'wheel_right': 0
} for r in commands
]
self.comm.send(commands)
if self.referee.can_play() or (not self.use_referee):
self.comm.send(commands)
else:
commands = [
{
'robot_id': r['robot_id'],
'color': r['color'],
'wheel_left': 0,
'wheel_right': 0
} for r in commands
]
self.comm.send(commands)
if self.referee.get_foul() != "STOP" and self.referee.get_foul() != None and self.referee.get_foul() != "HALT":
if self.match.coach.get_positions( self.referee.get_foul(), self.match.team_color.upper(), self.referee.get_color(), self.referee.get_quadrant() ):
self.referee.send_replacement(
self.match.coach.get_positions( self.referee.get_foul(), self.match.team_color.upper(), self.referee.get_color(), self.referee.get_quadrant() ),
self.match.team_color.upper()
)
if self.use_api:
self.api.send_data(self.match)
g = Game(config_file=args.config_file)