Skip to content
Snippets Groups Projects
Commit 612039af authored by Paul-Winpenny's avatar Paul-Winpenny
Browse files

Testing the -1 multiplier + pi

parent de28947d
No related branches found
No related tags found
No related merge requests found
......@@ -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"
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment