Resolve "simple pathfinding"

Closes #120 (closed)

cooperative_cuisine/configs/agents/random_agent.py

@@ -22,6 +22,8 @@ from cooperative_cuisine.utils import custom_asdict_factory
 
 TIME_TO_STOP_ACTION = 3.0
 
+ADD_RANDOM_MOVEMENTS = True
+
 
 def get_free_neighbours(
     state: dict, counter_pos: list[float] | tuple[float, float] | npt.NDArray
@@ -49,7 +51,7 @@ async def agent():
 
     args = parser.parse_args()
 
-    async with connect(args.uri) as websocket:
+    async with (connect(args.uri) as websocket):
         await websocket.send(
             json.dumps({"type": "ready", "player_hash": args.player_hash})
         )
@@ -58,6 +60,7 @@ async def agent():
         ended = False
 
         counters = None
+        all_counters = None
 
         movement_graph = None
 
@@ -89,10 +92,12 @@ async def agent():
             if movement_graph is None:
                 movement_graph = create_movement_graph(state, diagonal=True)
 
+
             if counters is None:
                 counters = defaultdict(list)
                 for counter in state["counters"]:
                     counters[counter["type"]].append(counter)
+                all_counters = state["counters"]
 
             for player in state["players"]:
                 if player["id"] == args.player_id:
@@ -166,7 +171,7 @@ async def agent():
                         for free in target_free_spaces:
                             try:
                                 modified_graph = restrict_movement_graph(
-                                    graph=movement_graph,
+                                    graph=movement_graph.copy(),
                                     player_positions=[
                                         p["pos"]
                                         for p in state["players"]
@@ -195,29 +200,32 @@ async def agent():
                                 movement = node_diff / node_dist
                             else:
                                 movement = target_diff / target_dist
+                            do_movement = True
                         else:
-                            movement = np.array([0, 0])
-                            task_type = None
-                            task_args = None
+                            # no paths available
+                            # task_type = None
+                            # task_args = None
+                            do_movement = False
 
-                        if target_dist > 1.2:
+                        if target_dist > 1.2 and do_movement:
                             if target_dist != 0:
-                                # random_small_rotation_angle = (
-                                #     np.random.random() * np.pi * 0.1
-                                # )
-                                # rotation_matrix = np.array(
-                                #     [
-                                #         [
-                                #             np.cos(random_small_rotation_angle),
-                                #             -np.sin(random_small_rotation_angle),
-                                #         ],
-                                #         [
-                                #             np.sin(random_small_rotation_angle),
-                                #             np.cos(random_small_rotation_angle),
-                                #         ],
-                                #     ]
-                                # )
-                                # movement = rotation_matrix @ movement
+                                if ADD_RANDOM_MOVEMENTS:
+                                    random_small_rotation_angle = (
+                                        np.random.random() * np.pi * 0.1
+                                    )
+                                    rotation_matrix = np.array(
+                                        [
+                                            [
+                                                np.cos(random_small_rotation_angle),
+                                                -np.sin(random_small_rotation_angle),
+                                            ],
+                                            [
+                                                np.sin(random_small_rotation_angle),
+                                                np.cos(random_small_rotation_angle),
+                                            ],
+                                        ]
+                                    )
+                                    movement = rotation_matrix @ movement
 
                                 await websocket.send(
                                     json.dumps(
@@ -238,6 +246,7 @@ async def agent():
                                 )
                                 await websocket.recv()
                         else:
+                            # Target reached here.
                             task_type = None
                             task_args = None
                     case "INTERACT":
@@ -299,9 +308,13 @@ async def agent():
                 # task_type = random.choice(["GOTO", "PUT", "INTERACT"])
                 threshold = datetime.now() + timedelta(seconds=TIME_TO_STOP_ACTION)
                 if task_type == "GOTO":
-                    counter_type = random.choice(list(counters.keys()))
-                    task_args = random.choice(counters[counter_type])["pos"]
-                    print(args.player_hash, args.player_id, task_type, counter_type)
+                    # counter_type = random.choice(list(counters.keys()))
+                    # task_args = random.choice(counters[counter_type])["pos"]
+
+                    random_counter = random.choice(all_counters)
+                    counter_type = random_counter["type"]
+                    task_args = random_counter["pos"]
+                    print(args.player_hash, args.player_id, task_type, counter_type, task_args)
                 else:
                     print(args.player_hash, args.player_id, task_type)
                     task_args = None