Update hmm_util.c

debugging countmat