Fixed some track stuff, added some AI pathfinding things with the new waypoint thing