Bellman Ford implemented and tested