File size: 380 Bytes
211ae03 | 1 2 3 4 5 6 7 8 9 10 11 12 13 14 | 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 |