Work on npcs
First try of pathfinding system