Adding the Heuristic Function concept and doing refactoring
Adding Mobility Heuristic Function