adding mujoco uds bridge

This commit is contained in:
Abhishek Joshi
2024-02-01 02:47:45 -06:00
parent 08bdc9f691
commit 75c0647bcc
5 changed files with 926 additions and 597 deletions
+12
View File
@@ -0,0 +1,12 @@
import numpy as np
def create_transform_matrix(rotation_matrix, translation_vector):
# Ensure rotation_matrix and translation_vector are NumPy arrays
rotation_matrix = np.array(rotation_matrix)
translation_vector = np.array(translation_vector)
transform_matrix = np.eye(4)
transform_matrix[:3, :3] = rotation_matrix
transform_matrix[:3, 3] = translation_vector
return transform_matrix