Ich hab mal folgenden Schaltplan gemacht:
Bild hier  
So sollte der Servo doch auch vom restlichen 5V-Kreis entkoppelt sein? Der Vorteil dabei wäre, dass der µC noch seine 5V bekommt.