Fix bug in multivariate Kalman smoother when observations are missing

The singularity branch did not correctly account for the switching number of observables

(cherry picked from commit cbc0cdfe)