![[PukiWiki]](image/robotics-logo-small.jpg "[PukiWiki]"){kind=logo}
ピンポン玉または青と赤のボールを運搬して、所定の容器の中に入れる。
ルールについて詳しくはこちら。
ロボットの全体像は下の写真である。前は黄色いパーツがついているほうで、RISが乗っているほうが後ろだ。
ロボットはアームと足回りの2つの部分に分けられる。以下でそれぞれについて説明する。
1.ピンポン玉の取り方
2.ピンポン玉の放し方
上の動画にもあるようにアームは上下に動いてピンポン玉を取ったりはなしたりする。
アームが完全に上がったときに少し斜めになっていて、ピンポン玉をつかむための黄色い部分が上がっても、ピンポン玉が落ちないようになっている。
アーム部分が重たいため、パワーを出すために6枚のギアを使用した。
アームの前と後ろの重さのバランスをとるために後ろにモーターを取り付けた。
後ろから動力を持ってくるために2か所で歯車を直角につけて、回転方向を変化させている。
また、下の写真のように歯車を取り付けて、パワーが出るようにした。
下の写真の ↓ は、ピンポン玉が逃げないようにするためのものだ。
ピンポン玉を拾った後、機体の上部にピンポン玉を乗せる役割をする。
ピンポン玉をコンベアで奥に送り、最大3つまで収納できるようになっている。
下の画像の ↓ の部分でコンベアをピンポン玉に押し付け、ピンポン玉が途中で止まることを防止した。
ベルトコンベアは片方が回転すればピンポン玉が収納できるので、片方のみ回転する。
コンベアを回転させるためのギアは、下の写真のように取り付けた。
上の写真のようにタイヤの上にRISを2台並べておいた。 赤外線送受信部をくっつけて通信を行えるようにした。
裏側
課題2と同様、タイヤは全部で3輪で、前輪2つが駆動輪、後輪1つは摩擦を減らすために、ゴムを外したホイールのみを取り付けた。
光センサーは、タイヤの中心に近いところに取り付けた。
車体が重たく、ガタガタ揺れると壊れそうだったので、極力ライントレースをしないように経路を考えた。
スタートしてから2本の黒い線を横切って、3本目の黒い線を認識したら、ライントレースを開始する。
上の図にあるようにしばらく進んだら、ピンポン玉を取り、その場で90度回転してピンポン玉をリリパックの中に入れる。
少し下がった後に90度回転し、リリパックに当たらないように移動した。
3本の黒い線を横切り、ここでもリリパックに当たらないよう、斜めに移動。
4本目の黒い線を横切った後、ライントレースを開始し、ピンポン玉をつかむ。
アームがリリパックの端に引っ掛かり、ピンポン玉がとれなくなることを防止するため、90度回転した後、少し下がってから、ピンポン玉をつかむようにした。
さらに下がり、90度回転する。
2本目の黒い線で停止、少し前進してリリパックにピンピン玉を入れる。
2台のRISで通信を行うために、以下のようにマクロを定義をした。
#define signal_catch 1 #define signal_release 2 #define signal_end 3
sub CATCH()
{
ClearMessage();
until(Message()==signal_catch); //signal_catchを受信するまで待機
OnFwd(OUT_B);
Wait(30);
Off(OUT_B);
Wait(100); // 下がる
SetPower(OUT_A,2);
OnRev(OUT_A);
Wait(90);
Off(OUT_A);
Wait(100); // 掴む
OnRev(OUT_B);
Wait(50);
Off(OUT_B);
Wait(100); // 上がる
OnFwd(OUT_A);
Wait(90);
Off(OUT_A);
Wait(100); // 手を元に戻す
OnFwd(OUT_C);
Wait(200);
Off(OUT_C);
Wait(100); // 奥へ送る
SendMessage(signal_end); //動作終了を足のRISに送信
}
SendMessage(signal_end);はアームの動作が終わってから足のプログラムを再開させるために入れた。足のプログラムにはuntil(Message()==signal_end);が入っていて、アームの動作が終わった後足の動作が再開されるようになっている。
sub release()
{
ClearMessage();
until(Message()==signal_release); //signal_releaseを受信するまで待機
OnFwd(OUT_B);
Wait(30);
Off(OUT_B);
Wait(100); // 下がる
OnRev(OUT_C);
Wait(200);
Off(OUT_C);
Wait(100); // 前へ送る
OnRev(OUT_B);
Wait(50);
Off(OUT_B);
Wait(100); // 上がる
SendMessage(signal_end); //動作終了を足のRISに送信
}
アームのメインプログラムは以下の通り。
task main()
{
ClearMessage();
CATCH(); //L'のピンポン玉を取る
release(); //リリパックに入れる
CATCH(); //Lのピンポン玉を取る
CATCH(); //リリパック内のピンポン玉を取る(1個目)
CATCH(); //リリパック内のピンポン玉を取る(2個目)
ClearMessage(); //(※)
until(Message()==signal_release);
OnFwd(OUT_B);
Wait(30);
Off(OUT_B);
Wait(100); //アームを下げる
OnRev(OUT_C);
Wait(200);
Off(OUT_C);
Wait(100); //ピンポン玉を前へ送る
OnRev(OUT_BC);
Wait(50);
Off(OUT_BC);
Wait(100); //アームを上げながらピンポン玉を送る
SendMessage(signal_end);
}
(※)以下のプログラムは基本的にはサブルーチンの release() と同じだが、アームを上げる際にもコンベアを動かしている。一番最後は複数のピンポン玉をリリパック内に入れる必要があるが、release() だとピンポン玉が全部箱に入る前に、動作が終わってしまう。また、先に入ったピンポン玉に邪魔をされてピンポン玉が全部出ないという問題を解決するためにアームを上げながらコンベアを動かすようにした。
#define black 40 //真っ黒 #define gray_black 44 //黒 #define gray 47 //灰 #define gray_white 50 //白 #define white 60 //真っ白
#define go_ahead OnFwd(OUT_AC); //前に進む #define turn_left OnFwd(OUT_A);Off(OUT_C); //左に曲がる #define turn_right OnFwd(OUT_C);Off(OUT_A); //右に曲がる #define circling_left OnRev(OUT_C);OnFwd(OUT_A); //左旋回する #define circling_right OnRev(OUT_A);OnFwd(OUT_C); //右旋回する
int t;
下にライントレースに使用したサブルーチンを示す。
sub follow_line()// 右側トレース
{
SetSensor(SENSOR_2,SENSOR_LIGHT);
ClearTimer(0);
while(FastTimer(0)<t)
{
if(SENSOR_2<black)
{
circling_right;
} //真っ黒なら右旋回せよ
else if(SENSOR_2<gray_black)
{
turn_right;
} //黒なら右に曲がれ
else if(SENSOR_2<gray)
{
go_ahead;
} //灰なら直進せよ
else if(SENSOR_2<gray_white)
{
turn_left;
} //白なら左に曲がれ
else if(SENSOR_2<white)
{
circling_left;
} //真っ白なら右旋回せよ
}
Off(OUT_AC);
Wait(100); //1秒止まれ
}
今回はコース取りの関係上交差点認識をする必要がないため、グローバル変数ｔを使って指定した秒数だけ動いて止まるようにしている。交差点認識について、詳しくは課題2のレポートを参照。
以下が足のメインプログラムである。 〇の中の数字は、経路の説明の図の数字に対応している。
task main()
{
ClearMessage(); // A'スタート
while(SENSOR_2>gray) //白なら進む ※1
{OnFwd(OUT_AC);}
Off(OUT_AC);
Wait(100);
while(SENSOR_2<gray) //黒なら進む
{OnFwd(OUT_AC);}
Off(OUT_AC);
Wait(100);
while(SENSOR_2>gray)
{OnFwd(OUT_AC);}
Off(OUT_AC);
Wait(100);
while(SENSOR_2<gray)
{OnFwd(OUT_AC);}
Off(OUT_AC);
Wait(100);
while(SENSOR_2>gray)
{OnFwd(OUT_AC);}
Off(OUT_AC);
Wait(100);
t=90;follow_line(); // ※2
Wait(100);
SendMessage(signal_catch); // L'のピンポン玉を掴む命令を送る��
ClearMessage();
until(Message()==signal_end); //アームの動作が終わるまで待機
circling_left; //左に90°旋回��
Wait(102);
Off(OUT_AC);
SendMessage(signal_release); // 1つ目のピンポン玉を箱に入れる命令を送る��
ClearMessage();
until(Message()==signal_end); // ※3
OnRev(OUT_AC); //後ろに下がる
Wait(30);
Off(OUT_AC);
circling_left;
Wait(102);
Off(OUT_AC); //左に90°旋回��
while(SENSOR_2>gray)
{OnFwd(OUT_AC);}
Off(OUT_AC);
Wait(100); //白なら進む ※1
while(SENSOR_2<gray)
{OnFwd(OUT_AC);}
Off(OUT_AC);
Wait(100); //黒なら進む
while(SENSOR_2>gray)
{OnFwd(OUT_AC);}
Off(OUT_AC);
Wait(100);
while(SENSOR_2<gray)
{OnFwd(OUT_AC);}
Off(OUT_AC);
Wait(100);
while(SENSOR_2>gray)
{OnFwd(OUT_AC);}
Off(OUT_AC);
Wait(100);
while(SENSOR_2<gray)
{OnFwd(OUT_AC);}
Off(OUT_AC);
Wait(100);
turn_right; //右に曲がる
Wait(100);
while(SENSOR_2>gray) //白なら進む ※1
{OnFwd(OUT_AC);}
Off(OUT_AC);
Wait(100);
while(SENSOR_2<gray) //黒なら進む
{OnFwd(OUT_AC);}
Off(OUT_AC);
Wait(100);
t=150;follow_line(); // ※2
SendMessage(signal_catch);// Lのピンポン玉を掴む命令を送る��
ClearMessage();
until(Message()==signal_end); // ※3
circling_left; //左に90°旋回��
Wait(102);
Off(OUT_AC);
OnRev(OUT_AC); //後ろに下がる��
Wait(23);
Off(OUT_AC);
SendMessage(signal_catch); //リリパックの中のボールを掴む(1個目)��
ClearMessage();
until(Message()==signal_end); // ※3
Wait(100);
SendMessage(signal_catch); //リリパックの中のボールを掴む(2個目)
ClearMessage();
until(Message()==signal_end); // ※3
OnRev(OUT_AC); //後ろに下がる
Wait(90);
Off(OUT_AC);
circling_left; //左に90°旋回��
Wait(102);
Off(OUT_AC);
while(SENSOR_2>gray) //白なら進む ※1
{OnFwd(OUT_AC);}
Off(OUT_AC);
Wait(100);
while(SENSOR_2<gray); //黒なら進む
{OnFwd(OUT_AC);}
Off(OUT_AC);
Wait(100)
while(SENSOR_2>gray)
{OnFwd(OUT_AC);}
Off(OUT_AC);
Wait(100);
go_ahead; //前に進む
Wait(15);
Off(OUT_AC);
SendMessage(signal_release); //ピンポン玉をリリパックに入れる命令を送る��
ClearMessage();
until(Message()==signal_end); // ※3
OnRev(OUT_AC);//リリパックから離れるために少し後ろに下がる
Wait(100);
Off(OUT_AC);
}
※1 光センサーを使って白と黒を感知し、while(SENSOR_2>gray){OnFwd(OUT_AC);}Off(OUT_AC); (白ければ直進せよ)、 while(SENSOR_2<gray);{OnFwd(OUT_AC);}Off(OUT_AC); (黒ければ直進せよ)という命令を任意の数並べることで、好きな黒線の手前、または、黒線を超えてからロボットを止めることができる。
※2 この後にあるピンポン玉をつかむプログラム、90°回転するプログラムが正確に機能するようにライントレースをして、ロボットを黒線となるべく平行にするためのプログラム。また、時間制御することで、ピンポン玉を取りやすい位置にロボットを移動させることができる。
※3 アームのRISから一連の動きが終わったという信号を受け取ってからプログラムを再開させるためのもので、アームが動きながら足も動くことを防ぐために入れた。
ロボット自体の動きは、良かったと思う。得点も取れなかったし、紙の上に置いてあったピンポン玉もつかめなかったが、リリパックの中のピンポン玉は2つとも取ることが出来てうれしかった。
ただ、調整段階では、ピンポン玉を4つともうまく運べていたので、今回ロボットが紙に引っ掛かってしまい得点をとれなかったのに悔しさもある。自分たちの詰めの甘さが本当に悔やまれる。
今回の課題は、課題1，2に比べて難しく、チームのみんなと沢山悩んだが、完成し自分たちの思い通りの動きができたときには、達成感を感じた。ロボコンは4位だったが、時間がない中、チームのメンバー4人がそれぞれの強みを生かしてロボットを作り上げることが出来たと思う。
shishi.jpg 201件
[詳細]
robo''.GIF 240件
[詳細]
robo'.GIF 288件
[詳細]
otete.jpg 238件
[詳細]
tenogia''.jpg 224件
[詳細]
tenogia'.jpg 253件
[詳細]
tenogia.jpg 220件
[詳細]
konbea1.jpg 242件
[詳細]
sutoppaa.jpg 225件
[詳細]
syunou.jpg 167件
[詳細]
kyatti'.jpg 158件
[詳細]
konbea.jpg 205件
[詳細]
zentai.jpg 225件
[詳細]
risokiba''.jpg 210件
[詳細]
ashiura''.jpg 217件
[詳細]
udegia'.jpg 169件
[詳細]
udegia_zu.jpg 225件
[詳細]
michi4.jpg 218件
[詳細]
michi3.jpg 118件
[詳細]
michi2.jpg 251件
[詳細]
michi1.jpg 245件
[詳細]
ko-su'.jpg 238件
[詳細]
