Primeiro commit do path finding..

Ainda refatorando.