Create FindOptimalCostPath.java