IP570 Lineaire Omgekeerde Pendule, STM32 Rotatie Omgekeerde Pendule LQR PID Automatische Energieregelaar