Añadido funcionamiento con servos
Frecuencia del PIC cambiada a 1 MHz.