mano na verdade a questao nao e o PID do robo mas sim o loop de controle rodando em frequencia errada sem sincronia com o ESC, le a doc.