Ya no se exactamente lo que quieres hacer pero empieza quitando el segundo
if (Serial.available()) {
data = Serial.read();
}
if ((data == 'F') || (data == 'f')) {
que sirve para encender y apagar los leds y mete las instrucciones de encender y apagar los leds donde mandas moverse al servo.
digitalWrite(13, HIGH);
servo1.write(pos1);
digitalWrite(13, LOW);
Esto es una idea luego puedes modificarlo a tu gusto. Salu2