PathFinding 1st version
with path finding