implementing new path finding alghorithm
finds pathes, but crashes.
improved search.