fix(pathfinding): return custom PathNotFoundError instead of NotFoundError

feat(pathfinding): create custom pathfinding

fix(pathfinding): update pathfinding to work with same position, small distances...

feat(pathfinding): add basic pathfinding using A*