Multiply two tf transforms converted to 4x4 matrices in python?
I want to do something along the lines of:
t = tf.getLatestCommonTime(l2, l4)
mat1 = transRotToMat4x4(tf.lookupTransform(l2, l1, t))
mat2 = transRotToMat4x4(tf.lookupTransform(l4, l3, t))
mat3 = mat1 * mat3
trans,rot = Mat4x4ToPosQuat(mat3)
br = tf.TransformBroadcaster()
br.sendTransform(
trans,
rot,
t,
"target",
"source");
Does transformations.py have something like transRotToMat4x4 and the complementary function for going the other direction?