Update hmm_util.c

debugging loop