Pero..... me cagüen la leche !!, qué me has liao !!??, que soy nuevo!! jaja.Es broma. 
Muchas gracias de verdad por contestar pero ahora me surgen otras dudas. Has declarado una función (si me equivo, por favor dímelo) que se llama millis. Pero, cuánto vale?.
Qué es " long inicio " ?
Qué es " 2000L "?
Que conste que estoy intentando probarlo pero tengo que meter lo que me has dado enmedio del código donde tengo declarado lo demás y se me está quejando de algunas cosas y claro. De momento me cuesta encontrar los fallos.