Implement Shortest Path Leetcode