Novo codigo. JM e Le, leiam depois :)

Juntei as tres funcoes (JM comemora hahaha) de um jeito que achei ser o
melhor. Configurei os motores fazendo o debouncing, que acabou sendo um
filtro. Pilhas acabaram, então só amanha pra continuar testando. Vejam o
que da pra aproveitar do codigo, ta bem melhor que o outro (eu acho, to
com sono, posso ta enganado).