センサレス姿勢制御モジュール完成 ーリアクションホイールへの道54ー

Home > 電子工作 > センサレス姿勢制御モジュール完成 ーリアクションホイールへの道54ー
すき 3
うんこ 0

先日は電流センサを用いて回転速度を推定するDCモータのセンサレス制御について学習しました。

 

ここではこのセンサレス回転速度制御を姿勢制御モジュールに応用してみます。

 

 

SHISEIGYO-1 DC 改造

1軸姿勢制御モジュール SHISEIGYO-1 DC をモータ電流をセンシングできるように改造して、回転速度を推定しての倒立を目指します。

SHISEIGYO-1 DC の製作レシピ

 

電流センサは以下を使用して、モータ配線間に挿入します。

Hailege 2個セット ACS712 20A電流センサーモジュールACS712 20A電流検出範囲Arduino用

Hailege 2個セット ACS712 20A電流センサーモジュールACS712 20A電流検出範囲Arduino用

  • Hailege
  • 価格¥850(2025/05/31 02:29時点)
  • 商品ランキング42,133位

 
コントローラはセンサレス回転制御の検討時と同様にATOMS3を採用しました。

 

回転速度を推定するので磁気エンコーダは除去しました。
今回使用した基板はモータドライバ (DRV8835)を裏面に実装する古いものを使用しました。

 

回転速度推定

1軸姿勢制御モジュール SHISEIGYO-1 DC は以下のようにモジュールの姿勢角(θb) とその角速度(θ˙b) とモータの回転速度(ω) からモータに入力するべき電圧 (実際にはモータドライバに印可するPWM信号のデューティ比)を導出しています。
 KpKdKwは調整パラデータ

V=Kpθb+Kdθ˙b+Kwω (1)

ここではモータの回転速度(ω) を磁気エンコーダによるものから電流センサによる推定値に変更します。

モータは以下のようにモデル化できます。Emは誘起電圧

上のモデルより回転速度(ω)は以下で導出できます。

ω=V(R+sL)IΦmVRIΦm (2)

インダクタンスの微分項は無視します。倒立時の応答はそれなりに早いので無視できない可能性ありますが簡単のために省略します!
Vは式(1)で算出された値、Iは電流センサで検出した値を用います。

モータの抵抗Rと磁束密度Φm前回測定した値を使用します。

式(2)で得た推定回転速度を式(1)のωにフィードバックして姿勢制御回転をさせます。

参考文献

高トルク&高速応答! センサレス・モータ制御技術 (パワー・エレクトロニクス・シリーズ)

高トルク&高速応答! センサレス・モータ制御技術 (パワー・エレクトロニクス・シリーズ)

  • 岩路 善尚 足塚 恭 共著
  • CQ出版
  • 価格¥3,960(2025/05/31 09:06時点)
  • 発売日2017/06/07
  • 商品ランキング135,609位

 

倒立動作

電流センサで回転速度を推定して倒立動作の検証を実施しました。

問題なく倒立動作が実現されました。
この変更に際して式(1)のKpKdKwは再調整しました。

 

おわりに

ここでは電流を検知して回転速度を推定し、磁気エンコーダなしでの姿勢制御モジュールの倒立動作を実現しました。

センサレス姿勢制御モジュールの爆誕です!
(まぁ電流センサ使ってるんだけど。。)

DCモータはフライホイールと磁気エンコーダ用の円盤磁石を取り付けるためにダブルシャフトモータを使っておりました。

この度 磁気エンコーダの除去が実現されたので、普通のモータでも姿勢制御できそうです。
また、電流センシング機能付きモータドライバを採用することで更にコンパクトなシステムが実現できるかもしれません。

次の記事

DRV8876を採用してセンサレス姿勢制御モジュール ーリアクションホイールへの道55ー

コメントはこちらから

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

This site uses Akismet to reduce spam. Learn how your comment data is processed.