this should return a covariance
motion prediction disabled for now
this is only saving the point cloud, not the actual distributions
also save Eigen means and covariances
do we want default values?
These should be arguments or const static members
reference for the paper
Different window sizes? based on sigma_u, sigma_v?