Heuristic Algorithm for Shortest Path Problem with Nonlinear Constraints