fix(pathfinding): update pathfinding to work with same position, small distances...
feat(pathfinding): add basic pathfinding using A*