Added Pose3::spatial_transform_to_matrix()