Bellman Ford Algorithm working. TODO: Add support for undirected graphs