Testing the -1 multiplier + pi

ros2/src/robobin/robobin/uwb_navigation_node.py

@@ -698,7 +698,9 @@ class UWBNode(Node):
         print(f" UWB heading:       {uwb_heading:.3f} rad ({uwb_heading_deg_normalized:.3f} deg)")
         print(f" IMU yaw:           {calib_end_yaw:.3f} rad ({calib_end_yaw_deg:.3f} deg)")
         print(f" --> OFFSET:        {offset_deg:.3f} deg (normalized to {offset_deg_normalized:.3f} deg)")
-                
+        
+        potential_solution_test = uwb_heading*-1 + math.pi
+        print(f"Potential Solution: {potential_solution_test}")
         self.calibration_active = False
         self.mode = "Manual"