convert_stategraph_to_costmatrix function

Convert a minimal state graph to a costmatrix