3軸 姿勢制御モジュール SHISEIGYO-3 の開発過程と今後の予定

Home > Advent Calendar > 3軸 姿勢制御モジュール SHISEIGYO-3 の開発過程と今後の予定
すき 0
うんこ 0

HomeMadeGarbage Advent Calendar 2020 |23日目
Arduino Advent Calendar 2020|23日目

今夏より姿勢制御モジュールの開発に凝っており、以下のように

今から50日前に3軸姿勢制御モジュールの完成を想定していたのですが、開発にはつきもののイレギュラーなことが起こり
現在完成には至っておりません。

ここでは言い訳としまして3軸姿勢制御モジュール SHISEIGYO-3の開発過程と今後の課題をまとめさせていただきます。

 

 

SHISEIGYO-1

SHISEIGYO-3の前に開発したSHISEIGYO-1を簡単に紹介させていただきます。

1軸の姿勢制御モジュール SHISEIGYO-1はリアクションホイールを1個搭載して辺倒立します。
また物理ブレーキなしでの起き上がり倒立も実現しました。

 

SHISEIGYO-2

SHISEIGYO-3と並行して2軸の姿勢制御モジュール SHISEIGYO-2も製作いたしました。

 

SHISEIGYO-3 開発過程

ここにSHISEIGYO-3の開発過程を記します。

点倒立検討

まずはX軸とY軸の2軸の制御で点倒立は実現できると考え、M5Stack Core2を用いて
Y軸を真ん中のリアクションホイール、X軸をサイドのリアクションホイール2個で制御してみましたがうまくいきませんでした。

SHISEIGYO-1 作例と代替部品の紹介

 

そこで3つのリアクションホイールを独立に制御しての点倒立を目指しました。
3つのモータを独立に制御するにはM5Stack Core2ではピンが足りなかったので、
真ん中のモータをM5Stack Core2で制御して、サイドのモータ2個をそれぞれATOM Matrix で制御しました。

更にフライホイ―ルのサイズを直径8cmのものから12cmに変更してトルクを向上させました。

 

恒久的ではないですが、3軸でのモータ制御で点倒立動作の確認をすることができました。

ちなみに筐体は3Dプリンタで作製しました。

マイコン削減

M5Stack Core2 とATOM Matrix 2個で点倒立動作を確認できましたが、もったいないのでM5Stack Core2のみでのモジュール制御を検討しました。

必然的にIMUセンサも1つになるので、座標変換して両サイドのモータ軸に対する角度や角速度を算出し倒立動作確認いたしました。

 

M5Stack Core2単体でモータ3個制御するにはピンが足りなかったため、ロジック制御ピンとして M5Stack用 I/O拡張ユニットを使用して対応しました。

 

しかし不幸なことに、ここでの作業の際に過電圧印可によりM5Stack Core2を壊してしまいました。。。

起き上がり辺倒立検討

マイコンを破壊してしまったので、ひとまず点倒立動作は置いておいて起き上がり動作の検討を実施いたしました。

SHISEIGYO-1は物理ブレーキなしにリアクションホイールの回転制御のみで起き上がり動作を実現しています。
SHISEIGYO-3でも物理ブレーキなしでの起き上がりを検討したところ。。。

モータから煙が出て壊れてしまいました。

要因としましてはフライホイールのサイズを大きくしたことと、モータ3個の実装を実現するためにSHISEIGYO-1よりもサイズの小さいものを使用しており負荷が大きくかかったためだと思います。

SHISEIGYO-1ではロングバージョンのブラシレスモータID-549XWを使用し、
SHISEIGYO-3ではショートバージョンのブラシレスモータID-529XWを3個使用していました。

起き上がりのために高速で回転し反転を繰り返して破壊しました。。。

物理ブレーキ検討

物理ブレーキなしでの起き上がりは断念して物理ブレーキの検討を開始しました。

TPUフィラメントを用いてバンドブレーキを製作し、サーボでブレーキを動かしての起き上がり辺倒立動作を実現することができました。

ここでは、筐体の倒立辺の角を丸めたり筐体を肉抜きして軽量化するなどの努力もしております。

ESP32採用

マイコンにESP32の開発ボードを採用しました。
潤沢にピンがあるので拡張ユニットなしに3個のモータを制御できました。

1軸 姿勢制御モジュール 物理ブレーキの検証 ーリアクションホイールへの道12ー

 
IMUセンサとしてMPU6050を使用しディスプレイも付けました。

倒立角 動的再調整システム確立

安定的な点倒立を実現するためにモータの回転数をフィードバックして倒立のための目標姿勢角度を動的に調整するシステム(IDRS:Inverted angle Dynamic Readjustment System )を確立しました。

 

まだまだ恒久的とは言えませんが、IDRSによって長時間の点倒立が実現できています。
ショートバージョンモータを一個 燃やしてしまったため、両サイドのモータをショートモータID-529XW、
真ん中をロングモータID-549XWを使用しております。
この非対称性が恒久的点倒立を難しくしていると考えております。

以下はIDRSの効能を示す動画です。

起き上がり点倒立実現

バンドブレーキを両サイドのホイールにも搭載し起き上がり点倒立を検討しました。

 

バンドブレーキに皮を張るなどの改良も加えて、点倒立動作を実現することができました。

 

SHISEIGYO-3 今後の課題

今後の課題としまして、破壊してしまったショートバージョンブラシレスモータID-529XWを入手しID-529XW3個での安定点倒立の実現が挙げられます。

AliExpressで購入済ですが配送に時間がかかるので、入手次第取り掛かりたいと思います。

 

おわりに

なんとか起き上がり点倒立動作の実現には至りましたがまだまだ完成とは言えない状況です。

これからもSHISEIGYO-3の開発に向けて昇進いたします。

さいごに開発年表を記します。

SHISEIGYO-3 開発年表

2020/10/15 SHISEIGYO-3の開発開始

2020/10/22 2軸制御での点倒立 断念

2020/11/09 3軸制御での点倒立動作 確認

2020/11/16 IMUセンサ 1個での点倒立動作確認
       M5Stack CORE2 破壊

2020/11/17 起き上がり動作検証時にブラシレスモータ破壊 

2020/11/18 物理ブレーキによる起き上がり辺倒立動作実現

2020/11/24 マイコンにESP32開発ボードを採用

2020/11/29 倒立角 動的再調整システム確立

2020/12/03 起き上がり点倒立 実現

 

コメントはこちらから

メールアドレスが公開されることはありません。コメントのみでもOKです。

このサイトはスパムを低減するために Akismet を使っています。コメントデータの処理方法の詳細はこちらをご覧ください