00001 import numpy as np 00002 import tf.transformations as tr 00003 00004 def tf_as_matrix(tup): 00005 return np.matrix(tr.translation_matrix(tup[0])) * np.matrix(tr.quaternion_matrix(tup[1]))