对齐场地几何与运行模式基础设施
This commit is contained in:
@@ -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) '''
|
||||
|
||||
Reference in New Issue
Block a user