Added dijkstra_heap: c, mex, m file; helper; add it to path in exp_setup