Added initial waypoints to show of functionality better