6 std::cout <<
"Merger called with invalid state" << std::endl;
Mixture of multi-variate gaussian states.
const std::shared_ptr< const MultiGaussianStateMerger< 5 > > theMultiStateMerger
TrajectoryStateOnSurface merge(const TrajectoryStateOnSurface &tsos) const
TrajectoryStateOnSurface tsosFromMultiGaussianState(const MultiGaussianState< 5 > &multiState, const TrajectoryStateOnSurface &refTsos)
MultiGaussianState< 5 > multiGaussianStateFromTSOS(const TrajectoryStateOnSurface &tsos)