Bueno, por fin, esto ya funciona, me dio por comprobar la salida de las patas con el osciloscopio y para mi sorpresa no salia nada, por lo que he cambiado las patas a C0 y C1 y ya esta, gracias nocturno66 por tu tiempo, tu codigo funciona bien.
Por cierto como puedo utilizar la pata A4, siempre da problemas por se colector abierto.