Implemented A* sometime, tried to fine tune it a little aaaaand stuff.
So now I am pushing this to github so I can find it on my main computer.