ho visto che includi due librerie solo se si vuole usare l'LCD, mi chiedevo se servisse veramente, perche' credo che se le librerie incluse non vengono usate nel codice compuque non vengono compilate giusto ? quindi potresti lasciarle e basta
lo schema elettrico di questo shield ? perche' non lo posti insieme alla scheda nel primo post ? siamo in Megatopic mica bruscolini 
Inoltre per il discorso leggibilita', essendo un codice bello lungo, io mi trovo molto bene con l'uso delle Tab nell'IDE ufficiale, chiarisce e distribuisce meglio il tutto.