C++ firmware for real controller MCU