
センサレス姿勢制御モジュール完成 ーリアクションホイールへの道54ー
先日は電流センサを用いて回転速度を推定するDCモータのセンサレス制御について学習しました。
ここではこのセンサレス回転速度制御を姿勢制御モジュールに応用してみます。
目次
SHISEIGYO-1 DC 改造
1軸姿勢制御モジュール SHISEIGYO-1 DC をモータ電流をセンシングできるように改造して、回転速度を推定しての倒立を目指します。
電流センサは以下を使用して、モータ配線間に挿入します。
Hailege 2個セット ACS712 20A電流センサーモジュールACS712 20A電流検出範囲Arduino用
- Hailege
- 価格¥850(2025/05/31 02:29時点)
- 商品ランキング42,133位
コントローラはセンサレス回転制御の検討時と同様にATOMS3を採用しました。
回転速度を推定するので磁気エンコーダは除去しました。
今回使用した基板はモータドライバ (DRV8835)を裏面に実装する古いものを使用しました。
回転速度推定
1軸姿勢制御モジュール SHISEIGYO-1 DC は以下のようにモジュールの姿勢角() とその角速度() とモータの回転速度() からモータに入力するべき電圧 (実際にはモータドライバに印可するPWM信号のデューティ比)を導出しています。
、、は調整パラデータ
ここではモータの回転速度() を磁気エンコーダによるものから電流センサによる推定値に変更します。
モータは以下のようにモデル化できます。は誘起電圧
上のモデルより回転速度()は以下で導出できます。
インダクタンスの微分項は無視します。倒立時の応答はそれなりに早いので無視できない可能性ありますが簡単のために省略します!
Vは式(1)で算出された値、Iは電流センサで検出した値を用います。
モータの抵抗と磁束密度は前回測定した値を使用します。
式(2)で得た推定回転速度を式(1)のにフィードバックして姿勢制御回転をさせます。
参考文献
高トルク&高速応答! センサレス・モータ制御技術 (パワー・エレクトロニクス・シリーズ)
- 岩路 善尚 足塚 恭 共著
- CQ出版
- 価格¥3,960(2025/05/31 09:06時点)
- 発売日2017/06/07
- 商品ランキング135,609位
倒立動作
電流センサで回転速度を推定して倒立動作の検証を実施しました。
問題なく倒立動作が実現されました。
この変更に際して式(1)の、、は再調整しました。
おわりに
ここでは電流を検知して回転速度を推定し、磁気エンコーダなしでの姿勢制御モジュールの倒立動作を実現しました。
センサレス姿勢制御モジュールの爆誕です!
(まぁ電流センサ使ってるんだけど。。)
DCモータはフライホイールと磁気エンコーダ用の円盤磁石を取り付けるためにダブルシャフトモータを使っておりました。
この度 磁気エンコーダの除去が実現されたので、普通のモータでも姿勢制御できそうです。
また、電流センシング機能付きモータドライバを採用することで更にコンパクトなシステムが実現できるかもしれません。