pytransform3d.uncertainty.pose_fusion#

pytransform3d.uncertainty.pose_fusion(means, covs)[source]#

Fuse Gaussian distributions of multiple poses.

Parameters:
meansarray-like, shape (n_poses, 4, 4)

Homogeneous transformation matrices.

covsarray-like, shape (n_poses, 6, 6)

Covariances of pose distributions in exponential coordinate space.

Returns:
meanarray, shape (4, 4)

Fused pose mean.

covarray, shape (6, 6)

Fused pose covariance.

Vfloat

Error of optimization objective.

References

[1]

Barfoot, T. D., Furgale, P. T. (2014). Associating Uncertainty With Three-Dimensional Poses for Use in Estimation Problems. IEEE Transactions on Robotics, 30(3), pp. 679-693, doi: 10.1109/TRO.2014.2298059.

Examples using pytransform3d.uncertainty.pose_fusion#

Fuse 3 Poses

Fuse 3 Poses