@@ -55,7 +55,7 @@ def __init__(self, *args, **kwargs):
5555 bot_id_param_name : str = self .get_parameter ('bot_id_param_name' ).value
5656 # Get the parameters from the blackboard
5757 params = get_parameters_from_other_node (self , param_blackboard_name , [
58- team_id_param_name ,
58+ team_id_param_name ,
5959 bot_id_param_name ])
6060 # Set the parameters
6161 self .team_number = params [team_id_param_name ]
@@ -69,13 +69,13 @@ def __init__(self, *args, **kwargs):
6969 #The publisher for the diagnostics
7070 self .diagnostic_pub = self .create_publisher (DiagnosticArray , "diagnostics" , 1 )
7171
72- # The time in seconds after which we assume the game controller is lost
72+ # The time in seconds after which we assume the game controller is lost
7373 # and we tell the robot to move
7474 self .game_controller_lost_time = 5
7575
7676 # The address listening on and the port for sending back the robots meta data
7777 self .addr = (
78- self .get_parameter ('listen_host' ).value ,
78+ self .get_parameter ('listen_host' ).value ,
7979 self .get_parameter ('listen_port' ).value
8080 )
8181 self .answer_port = self .get_parameter ('answer_port' ).value
@@ -110,7 +110,7 @@ def receive_forever(self):
110110 def receive_and_answer_once (self ):
111111 """ Receives a package, interprets it and sends an answer. """
112112 try :
113- # Receive the package
113+ # Receive the package
114114 data , peer = self .socket .recvfrom (GameStateStruct .sizeof ())
115115
116116 # Parse the package based on the GameStateStruct
@@ -136,26 +136,26 @@ def receive_and_answer_once(self):
136136 self .get_logger ().warn (f"Error while sending keep-alive: { str (e )} " )
137137
138138 def publish_diagnostics (self , received_message_lately : bool ):
139- """
139+ """
140140 This publishes a Diagnostics Array.
141141 """
142142 self .get_logger ().info ("No GameController message received" , throttle_duration_sec = 5 )
143143
144- #initialize DiagnsticArray message
144+ # initialize DiagnsticArray message
145145 diag_array = DiagnosticArray ()
146146
147- #configure DiagnosticStatus message
148- diag = DiagnosticStatus (name = "Game Controller" , hardware_id = "Game Controller" )
147+ # configure DiagnosticStatus message
148+ diag = DiagnosticStatus (name = "Game Controller" , hardware_id = "Game Controller" )
149149 if not received_message_lately :
150- diag .message = "Lost connection to game controller for " + str (int (self .get_time_since_last_package ().nanoseconds / 1e9 )) + " sec"
150+ diag .message = "Lost connection to game controller for " + str (int (self .get_time_since_last_package ().nanoseconds / 1e9 )) + " sec"
151151 diag .level = DiagnosticStatus .WARN
152152 else :
153153 diag .message = "Connected"
154- diag .level = DiagnosticStatus .OK
154+ diag .level = DiagnosticStatus .OK
155+
156+ diag_array .status .append (diag )
155157
156- diag_array .status .append (diag )
157-
158- #add timestamp to header and publish DiagnosticArray
158+ # add timestamp to header and publish DiagnosticArray
159159 diag_array .header .stamp = self .get_clock ().now ().to_msg ()
160160 self .diagnostic_pub .publish (diag_array )
161161
@@ -176,22 +176,22 @@ def answer_to_gamecontroller(self, peer):
176176
177177 def build_game_state_msg (self , state ) -> GameState :
178178 """ Builds a GameState message from the game state """
179-
179+
180180 # Get the team objects sorted into own and rival team
181181 own_team = GameStateReceiver .select_team_by (
182- lambda team : team .team_number == self .team_number ,
182+ lambda team : team .team_number == self .team_number ,
183183 state .teams )
184184 rival_team = GameStateReceiver .select_team_by (
185- lambda team : team .team_number != self .team_number ,
185+ lambda team : team .team_number != self .team_number ,
186186 state .teams )
187187
188188 # Add some assertions to make sure everything is fine
189189 assert not (own_team is None or rival_team is None ), \
190190 f'Team { self .team_number } not playing, only { state .teams [0 ].team_number } and { state .teams [1 ].team_number } '
191-
191+
192192 assert self .player_number <= len (own_team .players ), \
193193 f'Robot { self .player_number } not playing'
194-
194+
195195 this_robot = own_team .players [self .player_number - 1 ]
196196
197197 return GameState (
0 commit comments