Added waypoint system.