Update matrix calculations for Cbar

Also, the representation for the A matrix in the HMM code seems to be
different than the representation in the generateObservations code.
Either that, or I'm just getting lucky and my interpretation is totally
wrong.