![[PukiWiki]](image/robotics-logo-small.jpg "[PukiWiki]"){kind=logo}
半径1m以内にある懐中電灯を探して、懐中電灯にピンポン玉を当てるロボットを製作する。 ただしロボット本体が懐中電灯に接触しない限りどこからピンポン玉を放ってもよい。
課題2と同じライントレースロボットを使用した。センサーを本体の前部分に突き出すようにして取り付けた。
ロボットを１回転以上させ、その時光センサーで見つけた明るさが今までの最大の明るさを超えたらそこからタイマーをリセットして時間を測り始める。ただし初めは０の状態。そして回転が終わった時にタイマーに入っている時間だけ逆回転させる。これで最も明るかった場所＝ライトがあった場所が分かる。
#define turntime 360 //一回転する時間
task main()
{
SetSensor(SENSOR_2, SENSOR_LIGHT);
int lmax=0;
int tmax=0;
ClearTimer(0);
OnFwd (OUT_B); //ボールを取り込む
while (FastTimer(0)<=turntime)
{
OnFwd(OUT_A);
OnFwd(OUT_C);
if(lmax<=SENSOR_2) //明るさが今までの明るさの最大値を超えたなら
{ ClearTimer(1); //タイマーをリセットして
lmax=SENSOR_2; //明るさの最大値を更新して
PlaySound(SOUND_CLICK); //音を鳴らす
}
} //回転中に光源を探す
tmax=FastTimer(1);
ClearTimer(0);
while (FastTimer(0)<=tmax)
{
OnRev(OUT_C);
OnRev(OUT_A);
} //光源の方に逆回転で向き直す
Off(OUT_A);
Off(OUT_C);//ロボット停止
OnRev(OUT_B);//ボール発射
Wait(200);
Off(OUT_B);
}
20150716_190011.jpg