FIltro de Kalman ainda inacabado. E deletei sem querer o prj-firmware...
Retornando os arquivos que havia deletado sem querer.
Preparando para dar merge com o codigo do Patrick. Codigo do ESC aparentemente arrumado pelo Patrick