Ekumen-OS/beluga

Expand `MultivariateNormalDistribution` to SE3

Closed this issue · 0 comments

Feature description

We need a SE3 variant so that we can use this to:

  • Initialize SE3 particles given an initial pose and a covariance
  • Possibly as part of the implementation of the 3D variant of OmnidirectionalDriveModel

Implementation considerations

Coming up with a proper normally distributed rotation in SO3 is specially complicated. There's already been some discussion in #298 (comment).