Implemented SokobanHeuristic

Should be a simple manhattan distance between current box location to
goal box location.