function c = se3_plus(a,b) % se3_plus( {R1, T1}, {R2, T2} ) % % Group operation on SE(3) c = { b{1} * a{1}, a{2} + a{1}*b{2} };