２輪倒立振子ロボット２号機作成。

２輪倒立振子ロボット２号機作成の準備。

今度はモーターシールドを使ってシンプルにできないかを試す。

使用したのは、

・Arduino Duemilanove (使っているシールドがUNO R3対応でないため。I2Cを使わないならUNOでもOKのはず。)

・小型圧電振動ジャイロモジュール

・２Ａモーターシールド

・プロトタイピングボード

・タミヤ ユニバーサルプレート

・タミヤ ダブルギヤボックス

写真ではツインモーターギヤーボックスだが、ダブルギヤボックスに替えた。

ツインモーターギヤーボックスはガタが大きいのでこういう用途には向かないかも...

組み立て完了。モーターシールドを使ったので配線がすっきりした。

うまく立つかな〜

ゲインを調整して一応立つようにはなった。ソフトは１号機と同じ。

モーターシールドの特性のせいなのか、左右に同じ値を出力しているのに旋回してしまう。

左右でモーター出力を調整する必要あり。

ジャイロをアナログ出力からI2C接続のMPU-6050に替えてみる。

シールドにしたので交換は簡単。

MPU-6050についてはここを参考にさせていただく。

・Self balancing robot  Robotics - Electronics - Physical Computing

MPU-6050版、ここのソースを少し修正したらあっさり動いた。

・Its alive!  Asaphix

ただし立つところまでは行っていない。ゲインを調整しないと...　

やたら動きがカクカクするなと思って調べたら、出力が飽和して単なる正転／逆転の2値制御と同じになっていたことが判明。orz

まぁ2値制御でもそこそこ立つところまで持っていける事がわかったのは収穫。

MPU-6050版もやっと立つようになってきた。

MPU-6050のDMPを使うと自分でジャイロの補正処理を書かなくて済むので楽ちん。

モーターシールドを使ったので配線がすっきりした。

２輪倒立振子ロボットを作ってみた。（４）

タイヤをスリムタイヤからナロータイヤに替えてみた。

見た目がちょっとアンバランスなので...

ゲインを調整してだいぶ安定してきたが、チョットつつくと倒れてしまう。

これは今後の課題。

２輪倒立振子ロボットを作ってみた。（５）

つづく...

関連する記事

・２輪倒立振子ロボットを作ってみた。

・LEGO Mindstorms EV3でGyro Boyを動かしてみた。(その１) 

・LEGO Mindstorms EV3でGyro Boyを動かしてみた。(その２)

・Arduino + Processingで 「MPU-6050 ３軸ジャイロ３軸加速度センサー モジュール」を使ってみた。

参考リンク

・半日で作る倒立振子

 ・MPU-6050三軸加速度三軸ジャイロセンサーモジュール