add GeoHSMMStates E_step (most of one anyway)