Add speed waypoint trigger, stop pathfinding if y < -5