Got the servo working!