Adding support to viz logs for all agents

Author: mpragnay

pufferlib/ocean/drive/drive.h

@@ -63,6 +63,7 @@
 #define CONTROL_AGENTS 1
 #define CONTROL_WOSAC 2
 #define CONTROL_SDC_ONLY 3
+#define CONTROL_NONE 4 // All agents follow log trajectories; policy output is ignored
 
 // Simulation modes
 #define SIMULATION_GIGAFLOW 0
@@ -3218,7 +3219,7 @@ void set_active_agents(Drive *env) {
     }
 
     // In REPLAY mode, determine which agents to control
-    bool is_log_replay = (env->control_mode == CONTROL_SDC_ONLY);
+    bool is_log_replay = (env->control_mode == CONTROL_SDC_ONLY || env->control_mode == CONTROL_NONE);
     // In log-replay mode, no cap on actors
     int max_agents = is_log_replay ? env->num_total_agents : env->num_max_agents;
 
@@ -3307,7 +3308,7 @@ void move_expert(Drive *env, float *actions, int agent_idx) {
         return;
     }
 
-    bool is_log_replay = (env->control_mode == CONTROL_SDC_ONLY);
+    bool is_log_replay = (env->control_mode == CONTROL_SDC_ONLY || env->control_mode == CONTROL_NONE);
 
     Agent *agent = &env->agents[agent_idx];
     int t = env->timestep;
@@ -5076,13 +5077,16 @@ void c_step(Drive *env) {
         int expert_idx = env->expert_static_agent_indices[i];
         move_expert(env, env->actions, expert_idx);
     }
-    // Move active agents with policy actions
+    // Move active agents with policy actions (or expert log if CONTROL_NONE)
     for (int i = 0; i < env->active_agent_count; i++) {
         env->logs[i].score = 0.0f;
         env->logs[i].episode_length += 1;
         int agent_idx = env->active_agent_indices[i];
-        move_dynamics(env, i, agent_idx);
-        // move_expert(env, env->actions, agent_idx);
+        if (env->control_mode == CONTROL_NONE) {
+            move_expert(env, env->actions, agent_idx);
+        } else {
+            move_dynamics(env, i, agent_idx);
+        }
     }
 
     // -> 2. Compute metrics and rewards

pufferlib/ocean/drive/drive.py

@@ -253,10 +253,11 @@ def __init__(
             self.control_mode = 2
         elif self.control_mode_str == "control_sdc_only":
             self.control_mode = 3
+        elif self.control_mode_str == "control_none":
+            self.control_mode = 4
         else:
             raise ValueError(
-                "control_mode must be one of 'control_vehicles', 'control_agents', 'control_wosac', or "
-                f"'control_sdc_only'. Got: {self.control_mode_str}"
+                f"control_mode must be one of 'control_vehicles', 'control_agents', 'control_wosac', 'control_none', or 'control_sdc_only'. Got: {self.control_mode_str}"
             )
         if self.init_mode_str == "create_all_valid":
             self.init_mode = 0

scripts/render_scenario.py

@@ -25,6 +25,9 @@
     bev          - ego-following ortho camera with wireframe boxes (view_mode=1)
     topdown_sim  - fixed ortho camera over full map with 3D car models (view_mode=2)
     bev_all      - ego-following top-down showing all agents (view_mode=3)
+
+Other Options:
+    control_mode    - Use control_none to visualize all expert logs including ego, else defaults to control_sdc_only for replay and control_vehicles for gigaflow
 """
 
 import argparse