Added heuristic algorithms

First stable version with heuristic algorithms Greede and A*.