Added functions related with heuristic search

Added a simple lookahead . But not getting desired results.