diff --git a/guided_mrmp/main.py b/guided_mrmp/main.py
index b6a453f0d61ed435ef99dea3ead411180b10b3f2..8af5ba31095264b8404619b73b462405a8f66c4b 100644
--- a/guided_mrmp/main.py
+++ b/guided_mrmp/main.py
@@ -75,9 +75,6 @@ def initialize_robots(starts, goals, dynamics_models, env):
         print(f"waypoints = {waypoints}")
         
         r = Robot(i,color,RADIUS,start,goal,dynamics_model,3.0,1,.2,rrtpath,waypoints)
-        r.tracker.x_history.append(r.tracker.state[0])
-        r.tracker.y_history.append(r.tracker.state[1])
-        r.tracker.h_history.append(r.tracker.state[2])
         robots.append(r)
 
     return robots
diff --git a/guided_mrmp/utils/robot.py b/guided_mrmp/utils/robot.py
index f7bb75e423daabae6d3d797cc0cbf8c504d281b6..33ada249eaf58f532ab6a61ae4527c9e60c3688c 100644
--- a/guided_mrmp/utils/robot.py
+++ b/guided_mrmp/utils/robot.py
@@ -14,11 +14,6 @@ class Robot:
         self.next_step = None
         self.next_control = None
 
-        # if rrtpath is not None:
-        #     from guided_mrmp.controllers.path_tracker import PathTracker
-        #     self.tracker = PathTracker(start, dynamics_model,target_v, T, DT, waypoints)
-        
-
         self.x_history = [start[0]]
         self.y_history = [start[1]]
         self.h_history = [start[2]]