Separed Astar and Test algorithms so now the development of both is
easier. Astar for make it work, Test for optimizing.

Now the code shows prettier in console