Update hmm_util.c

Working on automatic generation of countmats