Implement Shortest Path Leetcode Java