Download real/teleop/utils/mat_tool.py from Tinghong-Ye22/code-Psi0-yth-v21: direct link, hf CLI and curl.
- Browser
- Download file 380 Bytes
-
https://huggingface.co/Tinghong-Ye22/code-Psi0-yth-v21/resolve/main/real/teleop/utils/mat_tool.py
- Command line
-
hf download hf://Tinghong-Ye22/code-Psi0-yth-v21/real/teleop/utils/mat_tool.py
-
curl -L -o mat_tool.py https://huggingface.co/Tinghong-Ye22/code-Psi0-yth-v21/resolve/main/real/teleop/utils/mat_tool.py
380 Bytes
| import numpy as np | |
| def mat_update(prev_mat, mat): | |
| if np.linalg.det(mat) == 0: | |
| return prev_mat, False # Return previous matrix and False flag if the new matrix is non-singular (determinant ≠ 0). | |
| else: | |
| return mat, True | |
| def fast_mat_inv(mat): | |
| ret = np.eye(4) | |
| ret[:3, :3] = mat[:3, :3].T | |
| ret[:3, 3] = -mat[:3, :3].T @ mat[:3, 3] | |
| return ret |