Motores, sensores e testes

Conclusão das rotinas dos motores, adição das rotinas dos testes e
inicio da inclusão dos LEDs de status.