2輪ロボット
2019/12/01
6月にAMAZONで二輪型倒立振子を買いました。
ELEGOO Tumbller Self-Blancing プログラミング二輪ロボットキット 子供向け Arduinoと互換できるSTEM玩具
倒立振子は、過去に何度かやりましたけどね。
買った理由は色々とあるのですが、
理由の一つが、
「がっしりとした２相エンコーダ付減速機DCモータ で制御実験してみたい」
ということなんですよ。
130系モータしか使ったことありませんから。
(^-^)/
2019/12/07
2輪ロボットの本体を３Dプリンタで自作中です。
モーターマウントがABSだとよわよわで制御の邪魔をしてくれそうですが、
とりあえずこのまま完成させようと思います。
2019/12/14
本体フレーム、カバー、モーターマウント、ホイール等の全部品をABSで3Dプリントしました。
なんとか二輪ロボットの形になりました。
よくあるシンプルな二輪ロボットです。
2輪ロボットについて学び始めるには、このシンプルさが私には丁度良いかと思っています。
〔電気部品〕
マイコン：Teensy3.2
IMU：MPU-6050
Bluetooth：HC-06
モータドライバ：TB6612FNG
DCモータ：GA37-520 12V 360RPM シャフト径6mm ギヤ比1：30
2019/12/14
4脚ロボットと同様に２輪ロボットもモータOFFの状態から起き上がれるようにプログラムを工夫してみました。
モータOFFの状態から起き上がらせるにはどうしたらよいのかを実験で確かめてみました。
その結果わかったのは、
・バランスPD制御のみで起き上がらせ、起きたと判断したら速度制御を加えて安定させる。
・制御の切り替え判定、切り替えタイミングをシーケンス制御で行なう。
その結果がこの動画です。
トリッキーな起き上がり方で、まぐれで立ちのように見えますが、ちゃんと再現性があります。
実験で成功した後、動画撮影で４、5回やりましたが失敗は１度もありませんでした。
2019/12/14
２輪ロボットに、一輪車の基本動作のアイドリングをやらせてみました。
※一輪車のアイドリングは、頭を軸に車輪を前後に振って停止する動作です。
少しずつ後方にズレていますが、気にせず次のステップへ進みたいと思います。
2020/03/08
年明けの１月2日に、今年はBoston DynamicsのHandleみたいなロボットが作りたいと書いてから２ヶ月がた経ちましたね。
1月と2月は自作３Ｄプリンタに興味が集中していて、ロボットのことを考えることはほとんど無かったんですが・・・。
しかし、遂に動き出しましたよ。
12月に製作した2輪ロボットに脚を付けてみました。
脚はつけたんですが、電気配線がまだなのでメカロックして格好だけとなってます。
脚をつけた分だけ重心が高くなったので、倒立の確認と外乱を与えてロバスト性を確認してみました。
いやこれが、予想以上に良い感じでビックリでした。
(^-^)/
2020/03/14
脚サーボ6個の配線をやりました。
とりあえず全サーボ の原点復帰動作をプログラミングして立ち姿勢で動作テストしました。
今回の動作テストの目的は、
・この重心の高さで立てるのか？
・移動も可能なのか？
・サーボ6個分のバックラッシュの悪影響はどれほどか？
主に、この3点です。
いやいや、これもあっさり合格点。
このあっさり合格は、ある意味良くないですね。
w(￣o￣)w
2020/03/21
スクワットをやってみる。
２輪ロボットに脚が着いて、まず確認してみたいこと。
足のホイール回転中心から重心までの距離が動的に変化することで何が起きるのか？
以下のようなことが関係してくると思うけど。
I: 慣性モーメント(moment of Inertia)
M: 質量(mass)
r: 回転半径(radius)
a: 角加速度(angular acceleration)
T: トルク(torque)
慣性モーメントI = Mr^2
トルクT = Ia
脚の長さが変わるということは、回転半径が変わり慣性モーメントが変わる。
それに前後移動や転倒時の角加速度が足モータの負荷トルクになるね。
これだけなら計算で済むことだけど。
これに、
・脚サーボのガタ
・DCモータのギヤのガタ
・脚の変形によるXZ方向の重心のブレ
・タイヤと床との摩擦
・機械損失
・コネクタの電気的な接触不良
考えすぎるとキリがない。
とりあえずフィードバックゲインは固定でスクワットをやらせてみました。
転倒もなく、予想より良い結果です。
しかし、動きに再現性がない。
ここから先の開発がちょっと心配。
(´･_･`)
2020/03/28
ロボットを、ちょっと跳ねさせてみた。
この動作は、ゲームやシミュレーションでよく使われる、ボールの跳ね返りの計算を使用しました。
上下方向の加速度は、加速度a=力F/質量mの力Fをロボットの挙動を見ながら調整。
反発係数は、減衰させないので1としました。
映像がいつもと違う？レンズが汚れていたようです。
(Ｔ＿Ｔ)
・・・
2020/04/18
２輪脚ロボット 左足首のハンチングの原因調査と対策。
症状：
ロボットの足を縮めるて座った姿勢にすると左足首サーボがプルプルとハンチング。
立ち姿勢にするとハンチングは収まる。
原因調査：
左足首サーボ(KRS2552）のパラメータ、ストレッチ60を30に設定変更すると収まる。
ストレッチを60から58、56、54と下げていくと30でハンチングが治まった。
しかし、ストレッチ30では動作が遅くて、このロボットには使えない。
ハンチングの原因は、サーボの寿命と判断し調査終了。
対策：
正常なサーボ に交換。
結果：
OK
以上
スポンサーリンク
2020.05.03 | コメント(0) | トラックバック(0) | 2輪ロボット
