Robot InsertWaypointPre