AStar Search working, TODO: set values of edges to decimal