Update hmm_util.c

working on outputting data