Don't assign tactics to robots if we don't have RobotStatus messages from them

[itsarune]

Description of the task

Currently, SensorFusion constructs a World object with friendly robots that we see with Vision.

Sometimes, a robot may stop being responsive on the field and the AI will still assign a tactic to it. This could be problematic if that robot was assigned to be an important crease defender blocking shots.

Our goal is to combine the vision feedback with the robot status messages we receive in SensorFusion to get a true sense of the robots that we are actually capable of commanding.

Possible implementation:

• Record the robot IDs of robots we've receive RobotStatus messages from
• Add some code to filter out robots from the output of createTeamDetection before passing into createFriendlyTeam
• Update MovePrimitive::updateObstacles to handle "dead" robots so that we don't plan trajectories that will collide with them

Acceptance criteria

• [ ] Add unit tests to SensorFusion to check that it considers RobotStatus messages when creating the friendly team
• [ ] Add unit tests to handle "dead" robots on the field (you may need to create a new move_primitive_test.cpp

Blocked By