Implemented Pathfinding algorithm and mouse controls