今回は、少しずつMiniPupperを動かす。
最終的には、Raspi４利用までやろうと思うが、完成版でなくリサーチ版入手なので、当初は、動きがわかっているAtom_liteを利用して動かそうと思う。
参考
今回は、以下の参考➀のAssemblyを見ながら組み立てました。
入手やRaspiのソフト、ロボット犬の知識のために以下リンクしておきます。
➀初心者もプロも楽しめる！自作できるロボット犬『Mini Pupperミニぷぱ』
➁Welcome to Mini Pupper’s documentation
➂ロボット犬「Mini Pupper」で遊んでみた
➃Mini Pupperを動かすまで（ソフトウェア準備編）
Atom_liteで動かす準備
Atom_liteとPCA9685を利用します。
結線は、通常のI2Cです。
また、付属の電源LiPo2S(7.4v?;実測)からPCA9685に電源供給
Atom_liteは開発中は、USBでWindows上のArduinoIDEを利用しています。
必要なライブラリーは、atomとAdafruit_PWMServoDriverを使います。
最低限のコード
四足歩行ロボット犬は、キャリブレーションが重要です。
以下のコードで、実施しました。
※コード解説は省きますが、mangdang社サーボは、サーボテスターで動かすと180度サーボでした
キャリブレーションの足の配置は、二種類ありますがべたっと座った参考➃の「現行キャリブレーションツール」の角度が合わせやすいです。
以下のコードでは、当初の45度の立ち姿のキャリブレーションのパラメータになっています。
#include <M5Atom.h>
#include <Wire.h>
#include <Adafruit_PWMServoDriver.h>
Adafruit_PWMServoDriver pwm = Adafruit_PWMServoDriver();
#define SERVOMIN 102
// 下で設定するPWM設定周波数を4096で分割したタイミングで制御する最小パルス幅 ：4096/20×0.5＝102.4 （0.5ms：SG90、0°の時のパルス幅）
#define SERVOMAX 492
// 下で設定するPWM設定周波数を4096で分割したタイミングで制御する最大パルス幅 ：4096/20×2.4＝491.5 （2.4ms：SG90、180°の時のパルス幅）
void servo_write_func(float p0,float p1,float p2,float p3,float p4,float p5,float p6,float p7,float p8,float p9,float p10,float p11){
servo_write(0, p0);
servo_write(1, p1);
servo_write(2, p2);
servo_write(3, p3);
servo_write(4, p4);
servo_write(5, p5);
servo_write(6, p6);
servo_write(7, p7);
servo_write(8, p8);
servo_write(9, p9);
servo_write(10, p10);
servo_write(11, p11);
}
float p0_=90,p1_=90, p2_=60;
float p3_=90,p4_=90, p5_=60;
float p6_=90, p7_=100, p8_=120;
float p9_=90, p10_=90, p11_=120;
int sk =0;
void calibrate(){
servo_write_func(
p0_,p1_, p2_,
p3_,p4_, p5_,
p6_, p7_, p8_,
p9_, p10_, p11_);
}
void loop() {
calibrate();
delay(1);
sk += 1;
}
void servo_write(int ch, int ang){ //動かすサーボチャンネルと角度を指定
ang = map(ang, 0, 180, SERVOMIN, SERVOMAX); //角度（0～180）をPWMのパルス幅（150～500）に変換
pwm.setPWM(ch, 0, ang);
}
そして、以下のパラメータでべったり座ったキャリブレーションができます。
void calibrate_(){
p0_,p1_+45, p2_+45,
p3_,p4_-45, p5_-45,
p6_, p7_+45, p8_+45,
p9_, p10_-45, p11_-45);
}
この二つの校正を連続すると校正１から２への動作をします。
つまり、こういうデータ列を連続して与えれば、ロボット犬が動いてくれます。
また、サーボ回転方向もわかると思います。
※ここで指示にサーボが追いつけるように、それぞれの関数にdelay(1000);を追記しています。
ここで一番大切なことは、キャリブレーションの位置に合わせて足の位置を正しく取り付けることです。
基準値で合わせることもできますが、必要に応じて取り付けなおすことをお勧めします。
void loop() {
calibrate();
calibrate_();
delay(1);
sk += 1;
}
同じように、ポーズ系の動作として、以下でステイのポーズが実現できます。
void stay(){
servo_write_func(
p0_,p1_, p2_+45,
p3_,p4_, p5_-45,
p6_, p7_, p8_+25,
p9_, p10_, p11_-25);
delay(1000);
}
連続動作
ポーズの連続動作として、伸びやちんちんそしてお手があります、
こまどり写真の要領ですが、それぞれ以下で実現できました。
伸び
void nobi(){
servo_write_func(
p0_,p1_+45, p2_+45,
p3_,p4_-45, p5_-45,
p6_, p7_+45, p8_+45,
p9_, p10_-45, p11_-45);
delay(2000);
servo_write_func(
p0_,p1_+45, p2_+45,
p3_,p4_-45, p5_-45,
p6_, p7_, p8_+25,
p9_, p10_, p11_-25);
delay(1000);
servo_write_func(
p0_,p1_-0, p2_+85,
p3_,p4_+0, p5_-85,
p6_, p7_, p8_+25,
p9_, p10_, p11_-25);
delay(2000);
}
ちんちん
void chinchin(){
servo_write_func(
p0_, p1_+45, p2_+45,
p3_, p4_-45, p5_-45,
p6_, p7_+45, p8_+45,
p9_, p10_-45, p11_-45);
delay(2000);
servo_write_func(
p0_,p1_-45, p2_+45,
p3_,p4_+45, p5_-45,
p6_, p7_+45, p8_-0,
p9_, p10_-45, p11_+0);
delay(1000);
servo_write_func(
p0_,p1_+45, p2_+45,
p3_,p4_-45, p5_-45,
p6_, p7_+60, p8_-30,
p9_, p10_-60, p11_+30);
delay(2000);
}
お手
void ote(){
servo_write_func(
p0_,p1_, p2_+45,
p3_,p4_, p5_-45,
p6_, p7_, p8_+25,
p9_, p10_, p11_-25);
delay(1000);
servo_write_func(
p0_-10,p1_+90, p2_+85,
p3_-10,p4_, p5_-45,
p6_, p7_, p8_+25,
p9_, p10_, p11_-25);
delay(1000);
servo_write_func(
p0_-20,p1_+30, p2_+85,
p3_-10,p4_, p5_-45,
p6_, p7_, p8_+25,
p9_, p10_, p11_-25);
delay(2000);
}
時系列関数を利用する
連続動作を再現するために、時間に依存して数値を変える関数を導入する。
ジャンプ
単純にその場でジャンプする関数は、以下の通り。
前後左右の足がそろっているので、比較的簡単に実現できる。
void jump(){
servo_write_func(
p0_,pk*(sk%st-st2)+p1_, -pk*(sk%st-st2)+p2_,
p3_,-pk*(sk%st-st2)+p4_, pk*(sk%st-st2)+p5_,
p6_,-pk*(sk%st-st2)+p7_, pk*(sk%st-st2)+p8_,
p9_,pk*(sk%st-st2)+p10_, -pk*(sk%st-st2)+p11_);
delay(25);
}
足踏み
関数で動かす場合、左右前後の足の位相を考慮して動かす。
一番簡単な足踏みは、以下のような関数で実現できる。
void asibumi(){
st = 32;
st2 =st*0.5;
pk=0.5;
servo_write_func(
p0_,pk*(sk%st-st2)+p1_, -pk*(sk%st-st2)+p2_,
p3_,pk*(st2-int(sk-st2)%st)+p4_, -pk*(st2-int(sk-st2)%st)+p5_,
p6_,pk*(sk%st-st2)+p7_, -pk*(sk%st-st2)+p8_,
p9_,pk*(st2-int(sk-st2)%st)+p10_, -pk*(st2-int(sk-st2)%st)+p11_);
delay(50);
}
歩行
歩行は、比較的難易度が高く、以下の関数で一応実現できる。
void walk(){
st = 32;
st2 =st*0.5;
pk=1;
servo_write_func(
p0_,pk*(st2-int(sk-st2)%st)+p1_, 0.5*pk*(st2-int(sk-st2)%st)+p2_,
p3_,pk*(sk%st-st2)+p4_, 0.5*pk*(sk%st-st2)+p5_,
p6_,p7_, -0.8*pk*(sk%st-st2)+p8_,
p9_,p10_, -0.8*pk*(st2-int(sk-st2)%st)+p11_);
delay(10);
}
少し進化したものとして、以下のように後ろ脚も駆動させ、ゆっくり動かしてみる。
※ターゲットになるパラメーターが見えるのであとで最適解を探してみよう
void walk(){
st = 32;
st2 =st*0.5;
pk=1;
servo_write_func(
p0_,pk*(st2-int(sk-st2)%st)+p1_, 0.5*pk*(st2-int(sk-st2)%st)+p2_,
p3_,pk*(sk%st-st2)+p4_, 0.5*pk*(sk%st-st2)+p5_,
p6_,0.25*pk*(sk%st-st2)+p7_, -0.8*pk*(sk%st-st2)+p8_,
p9_,0.25*pk*(st2-int(sk-st2)%st)+p10_, -0.8*pk*(st2-int(sk-st2)%st)+p11_);
delay(50);
}
左右旋回
旋回のもっとも簡単なコードは以下の通り
void r_turn(){
pk=0.25;
servo_write_func(
p0_+pk*(sk%st-st2),pk*(sk%st-st2)+p1_, p2_,
p3_+pk*(sk%st-st2),pk*(sk%st-st2)+p4_, p5_,
p6_+pk*(sk%st-st2),p7_, -pk*(sk%st-st2)+p8_,
p9_+pk*(sk%st-st2),p10_, -pk*(sk%st-st2)+p11_);
delay(2);
}
void l_turn(){
pk=0.25;
servo_write_func(
p0_-pk*(sk%st-st2),-pk*(sk%st-st2)+p1_, p2_,
p3_-pk*(sk%st-st2),-pk*(sk%st-st2)+p4_, p5_,
p6_-pk*(sk%st-st2), p7_, pk*(sk%st-st2)+p8_,
p9_-pk*(sk%st-st2), p10_, pk*(sk%st-st2)+p11_);
delay(2);
}