对齐场地几何与运行模式基础设施

This commit is contained in:
jjh
2026-04-02 11:50:35 +08:00
parent 4b9d5afbb6
commit 3d1fc285d3
7 changed files with 243 additions and 91 deletions

View File

@@ -51,6 +51,7 @@ class MathOps():
if size == 0: return vec
return vec / size
@staticmethod
def rel_to_global_3d(local_pos_3d: np.ndarray, global_pos_3d: np.ndarray,
global_orientation_quat: np.ndarray) -> np.ndarray:
''' Converts a local 3d position to a global 3d position given the global position and orientation (quaternion) '''