Added simple heuristic

Added simple heuristic