AYUDA-- ROBOT DIRGIDO DESDE LA PC

Buenas Comunidad... estoy realizando un Robot Movil, este robot es dirigido desde la pc utilizo la arduino UNO, tengo un pequeño problema, estes robot detecta obstaculos mediante el sensor sharp 21y0a21, uso los encoders pololu, un servomotor y modulos Xbee, realice un shield donde estan las conexiones de control de puente H,sensor y Servo, otro pcb pala regulacion y otro el de potencia puente H , es un movil diferencial de 2 ruedas y 2 encoders, y el Gran Problema que tengo es que al momento de conectar todo en especial el servo motor, el circuito entra en interferencia si no le agrego unas lineas de codigo al main, el servomotor empieza a moverse sin necesidad. he probado condensador bypass pal servo, diodos para evitar el flujo de corriente de retroalimentacion, el servo es un HS311...

Necesito ayudaaaa!!!!

Alguien que me pueda colaborar....

una cosita uso interruociones de cambio de pin que provee pololu library avrs y la interrupcion del comparador analogo del avr...