Use math::SE3 with initialization with math::SE3::Identity().