Block and Pathing AI

Added waypoints and broken pathing.