Skip navigation
高専ロボコン2026全国大会 茨城で制御と操縦やってました
0:00 / 0:25

高専ロボコン2026全国大会 茨城で制御と操縦やってました

Kazusa Hashimoto 橋本千聡

@kzs3212.7K followers

Visit on X
630 likesDownloadOriginal post

49,630 views

高専ロボコン2026全国大会 茨城で制御と操縦やってました 今年は勝つための制御を頑張りました 軌道生成 非線形最適化を行い時間最小で到達できる軌道を事前に作成していました 部屋のPCから設定を変更でき、各軌道0.1秒程度で解くことができ、50本の軌道を3秒ほどで解けます タイヤのモーターやステアリングのモーターの最大加速度、最高速度を制約に入れているので実機で実際に追従可能なレベルまで解いてます またロボットを正方形と仮定し障害物距離を計算することで、障害物を避ける軌道を作っています 速度に応じて障害物距離のクリアランスを増やすようにしているのでパラメーター調整前でも当たりにくくなってます 地区大会ではIPOPTを使っていましたが全国に向けて練習する過程で最適化を行う時間がもったいなかったのでFATROPに変更し、高速化できました 実際のコードのコピーを後日公開予定です 軌道追従 自己位置推定の結果を用いて一番距離が近い点を選び、その点に含まれるロボットの速度、加速度情報をもとに追従しています 速度のFFだけだとタイヤのモーターの速度PIDのDゲインの調整が必要で嫌だったので加速度電流変換係数を計算し、速度PIDの出力に変換後の電流値をFFで追加しています これにより正確なタイミングで加減速を行うことができました また遠心力などの物理現象の対策としてステアリングモーターの速度FFも使っています またモーターの追従遅れや自己位置の遅れなどを考慮した際、最も影響があるのは旋回しながらの移動だったので旋回速度に比例して速度ベクトルを回転させる補正も入れています これらをすべて合わせると事前に計算した軌道をきれいに追従することができました 動き出しから動き終わりまでの平均位置誤差は±1.2cmでした こちらはnatto libraryに統合予定です 自己位置推定 今回もステアのホイールオドメトリ+LiDARのMCLにしました 今回はLiDARを3つ使っていたのですが点群を合成するときに時刻のズレが問題になりました そこでいくつか対策を行いましたが一番効果的だったのは 合成しない でした 最終的に3つの点群を合成せずmclに投げることで30x3 =90Hzで更新を行っていました 合成のパススルーやmclの更新もnatto libraryに統合予定です コントローラー 今年も安定のros2 for unityです マップの上にピンを表示しタップしたところに行けるようになってます また初動の端まで逃げる軌道などすべての点で計算する必要のないものは特殊軌道として登録しており、テンキーのようなボタンを押してその軌道を読み込んでます 地区大会で大変だったセッティングタイムにスタートゾーンにロボットを収めるのも自動にしました コントローラーのapkおよびubuntu用バイナリは後日公開予定です シミュレーション 今年も自作です 雑巾の挙動はシミュレートする意味がないのでそれ以外をやりました これにより限られた練習時間の大半を雑巾を投げるのに使うことができました 実際の試合データや練習データから時定数や最高速度などを算出し試合の流れなどを何度も練習しました 低レイヤー 特にすごいことはしてないです 今年からnucleo脱却しHALを使い始めました FDCAN 1M/5Mbps で通信しています ロボマスモーターを制御する基板x4 磁気エンコーダー基板x5 リミットスイッチ基板x1 サーボ基板x1 を一つのバスにつないでます ロボットにはorange pi 5 plusを載せています EtherNetでマイコンと通信しUDPでCANのパケットを送受信してます また各基板にUSBが付いているのでCDCを使ったTUIを作成し、基板IDやPIDゲインなどのパラメーターを変更できるようにしました パラメーターはフラッシュに保存できるようにしてます 動画1:スマホコントローラー(スマコン)で自動運転してる様子 動画2:地区大会時の激遅非線形最適化 動画3:地区大会後に非線形最適化の最適化を行なったあとの様子 動画4:6月頃 旋回補正に氣づいてしまい綺麗に追従できている様子

3 Comments

Comments from the original post on X (Twitter)

  • Kazusa Hashimoto 橋本千聡's profile picture

    @kzs321

    動画5:4月のbang bang制御入門 動画6:CDCでマイコン設定変えられて便利 動画7:関東決勝のrosbagをviewerと配信で同時視聴 動画8:非線形最適化とき終わったあとの可視化ツール

    30 likes

  • Kazusa Hashimoto 橋本千聡's profile picture

    @kzs321

    動画9:スーパーを投げて旗にかける人の動き解析 動画10:定点カメラ雑巾軌道可視化 動画11:正方形ロボットのyaw込みで障害物当たり判定 動画12:ロボット視点の自動

    15 likes

  • Kazusa Hashimoto 橋本千聡's profile picture

    @kzs321

    質問あれば追記します

    2 likes