changed origin robot pose to a none local variable

thedropbears · Jan 27, 2025 · 93e6104 · 93e6104
1 parent 69a2b57
commit 93e6104
Showing 1 changed file with 2 additions and 2 deletions.
diff --git a/controllers/reef_intake.py b/controllers/reef_intake.py
@@ -45,10 +45,10 @@ def intaking(self, initial_call: bool):
     @state(must_finish=True)
     def safing(self, initial_call: bool):
         if initial_call:
-            origin_robot_pose = self.chassis.get_pose()
+            self.origin_robot_pose = self.chassis.get_pose()
         robot_pose = self.chassis.get_pose()
 
-        distance = origin_robot_pose.translation() - robot_pose.translation()
+        distance = self.origin_robot_pose.translation() - robot_pose.translation()
 
         if distance.norm() >= self.UNSAFE_DISTANCE:
             self.done()