Teste US e wait sem delay.

Codigo do US alterado, funcao que verifica se tempo desde a ultima
leitura ja foi o suficiente criada (para evitar usar delay e travar o
codigo). Como as leituras serao sequenciais apenas uma variavel para
armazenar o tempo foi criada.
Victor

Funcoes teste do victor