Added Python yaw/heading helper functions.

PointOneNav · Dec 2, 2024 · 92b3b5b · 92b3b5b
1 parent 29df295
commit 92b3b5b
Showing 1 changed file with 8 additions and 0 deletions.
diff --git a/python/fusion_engine_client/messages/defs.py b/python/fusion_engine_client/messages/defs.py
@@ -785,3 +785,11 @@ def PackedDataToBuffer(packed_data: bytes, buffer: Optional[bytes] = None, offse
         return buffer
     else:
         return len(packed_data)
+
+
+def yaw_to_heading(yaw_deg: Union[float, np.ndarray]):
+    return 90.0 - yaw_deg
+
+
+def heading_to_yaw(heading_deg: Union[float, np.ndarray]):
+    return 90.0 - heading_deg