Add: waypoint save