自己バランス調整LQR制御シンプルFOC三角形ロボットキット Arduino ESP32 オープンソース対応