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