課題内容

半径1m以内にある懐中電灯を探して、懐中電灯にピンポン玉を当てるロボットを製作する。 ただしロボット本体が懐中電灯に接触しない限りどこからピンポン玉を放ってもよい。

ロボット

課題2と同じライントレースロボットを使用した。センサーを本体の前部分に突き出すようにして取り付けた。

20150716_190011.jpg

動画

プログラム

光センサーについて

ロボットを1回転以上させ、その時光センサーで見つけた明るさが今までの最大の明るさを超えたらそこからタイマーをリセットして時間を測り始める。ただし初めは0の状態。そして回転が終わった時にタイマーに入っている時間だけ逆回転させる。これで最も明るかった場所=ライトがあった場所が分かる。

プログラム内容

#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);
}

添付ファイル: fileIMG_8741.MOV 90件 [詳細] file20150716_190011.jpg 94件 [詳細]

トップ   編集 凍結 差分 バックアップ 添付 複製 名前変更 リロード   新規 一覧 単語検索 最終更新   ヘルプ   最終更新のRSS
Last-modified: 2015-08-11 (火) 18:21:43 (1473d)