Changed Servo pins to match current HW revision