SD and Servo working together