Write servo software