Линейный инвертированный маятник IP570, автоматический энергетический контроллер LQR PID с вращающимся инвертированным маятником STM32