colav cleanup

vortexntnu · Aug 10, 2024 · a36a19d · a36a19d
1 parent bf6d335
commit a36a19d
Show file tree

Hide file tree

Showing 3 changed files with 4 additions and 168 deletions.
diff --git a/motion/colav/scripts/VO_visualize.py b/motion/colav/scripts/VO_visualize.py
diff --git a/motion/colav/scripts/colav_sim.py b/motion/colav/scripts/colav_sim.py
@@ -86,7 +86,10 @@ def obstacle_callback(self):
     def get_heading(msg: Odometry):
         orientation_q = msg.pose.pose.orientation
         orientation_list = [
-            orientation_q.w, orientation_q.x, orientation_q.y, orientation_q.z
+            orientation_q.w, 
+            orientation_q.x, 
+            orientation_q.y, 
+            orientation_q.z
         ]
         heading = quat2euler(orientation_list)[2]
         return heading

diff --git a/motion/colav/scripts/cone_visualizer.py b/motion/colav/scripts/cone_visualizer.py