制御のゲーム

Last updated at 2025-01-11Posted at 2025-01-11

１．はじめに

倒立振子のレースゲームPaul Kartを作りました。
(サイズがでかいのでCtrl-で適宜縮小推奨)

とりあえずタイムアタックモードのみ実装しています。トップ画面から
[START GAME]→[Select Stage]でゲーム画面へ遷移できます。

デフォルトの操作は以下の通りです。

制御入力に利用できるエネルギーには制限があり、エネルギー残量以上の制御入力は実行できません。ポールカート背面のゲージでエネルギー残量を確認できます。エネルギー残量は時間経過により回復します。

本ゲームではポールカートの操作に用いる制御系の調整と設計を行うことができます。制御器はデフォルトの可調整パラメータ付きのPID制御器か、WebSocket通信を経由した外部アプリケーションから選択可能です。

倒立振子「ポールカート」各部詳細

ポールカートには以下２種類のアクチュエータが搭載されています。

ポールカートの座標系は右-上-前の左手系で表現されます。各アクチュエータの回転方向も各軸左ねじ方向を正と定義します。

ポールカートの制御のため、以下の情報がセンサから取得可能です。

ポールの姿勢は、ポール座標系と、ポール座標系の上下軸が鉛直上向きとなるように平面上で回転させた座標系との各軸の角度差で計測されます。

ポール座標系各軸周りの角速度です。

球状ホイールの各軸周りの角速度です。

ポール座標系上下軸周りの角速度です。

トップ画面の[CONTROL DESIGN]で制御設計画面に遷移し、[Type]をDefault PIDとすることで利用するコントローラをPIDに切り替えて調整、走行が可能となります。

この画面でパラメータを調節し、Applyすることで制御器を調整できます。転倒した場合は[Reset]してください。

デフォルトPID制御器では、$x$, $y$, $z$の３軸のPID制御器が構成されています。$x$および$z$軸の制御器はそれぞれ左右軸、前後軸方向にホイールを駆動し安定化を行います。ユーザ制御はアクチュエータへのオフセット入力として印加されます。

$y$軸の制御器は上下軸回りの回転安定化のため、角速度0を目標に安定化制御を行います。ユーザ制御は目標角速度へのオフセット入力として印加されます。

より高い設計自由度のため、WebSocket通信を用いて外部アプリケーションによる制御を行うことができます。外部アプリケーションの一例としてPythonおよびMATLABを用いた実装サンプルを用意しています。

WebSocket制御器を利用するためには、制御設計画面で[Type]をCustom WebSocketに設定します。

センサ情報は以下の41バイトのデータで送信されます。

外部アプリケーションが返す制御入力は以下の12バイトで送信されます。