MCPcopy Create free account
hub / github.com/ChristopherLu/milliEgo / pose2T

Function pose2T

eulerangles.py:419–427  ·  view source on GitHub ↗
(pose)

Source from the content-addressed store, hash-verified

417 return mat2euler(M)
418
419def pose2T(pose):
420 import nibabel.quaternions as nq
421 R = nq.quat2mat(pose[3:])
422 T = np.array([[R[0,0], R[0,1], R[0,2], pose[0]],
423 [R[1,0], R[1,1], R[1,2], pose[1]],
424 [R[2,0], R[2,1], R[2,2], pose[2]],
425 [0,0,0,1]])
426 # T = np.vstack((T, [0, 0, 0, 1]))
427 return T

Callers

nothing calls this directly

Calls

no outgoing calls

Tested by

no test coverage detected