Primeira integração de todo o código.
YPR convertidos para graus/seg.
Correção da leitura do ROLL (sobrescrevendo pino do motor).
Não trava mais, mas perde leituras do giroscópio.