Pêndulo Invertido Linear IP570, Pêndulo Invertido Rotativo STM32, Controlador Automático de Energia LQR PID