OK, un problema alla volta:
1 - visto che devi leggere uno status su un pin o sull'altro il deviatore va bene, meglio la versione di cui parlavi all'inizio cosi non sei costretto ad attivare per forza uno dei due.
2 - Però tutto quel casino non ti serve, una volta che hai impostato i pin 5 e 6 come ingressi, attivi le pull-up interne e ti basta una sola delle vie del deviatore: al centro colleghi il GND, un laterale al 5 e l'altro laterale al 6, senza che colleghi anche il +5. (per capirci tu ora hai messo il centrale di una via sul 5 ed il centrale dell'altra via sul 6).
3 - E tutto questo può andare benissimo se stabilisci con certezza che i servo a riposo NON consumano nulla altrimenti quello schema diventa uno spara-batterie. I servo li hai tu non io: metti il tester per le misure in corrente, in serie al +5 e vedi se il servo assorbe corrente o meno.