Added header files to Makefile
Made progress fixing pathfinding