Il consiglio è ... NON reinventare l'acqua calda quando c'è gente che ci ha speso anni per fare cose semplici, efficienti, funzionanti e ... affidabili 
Prova a guardare, in questa stessa sezione, tra i primi thread, ovvero QUI ... è una libreria Arduino manutenuta e supportata ... 
Guglielmo
P.S.: ... ovviamente è solo un consiglio ... poi divertiti come più ti piace