#contents

*目標 [#e227aa1a]
半径1m以内にある懐中電灯を探して、懐中電灯にピンポン玉を当てるロボットを製作。

*プログラム [#g973589c]

**定義 [#j3a73b79]
 #define turn_left OnFwd(OUT_C);OnRev(OUT_A)// 左旋回
 #define turn_right OnFwd(OUT_A);OnRev(OUT_C)// 右旋回

**プログラム [#q7e1d0ea]
 task main()
 
 {
 
	SetSensor(SENSOR_3,SENSOR_LIGHT);
 
	int lightsensor=0;
	int d_max=0;
 
	ClearTimer(0);
	turn_left;
 
	while (FastTimer(0) < 330) {
 
		if (SENSOR_3 > lightsensor){
			lightsensor=SENSOR_3;
			d_max=FastTimer(0);
			}
	}
 
	Off(OUT_AC);Wait(100);
	
         turn_right;
	Wait(330);
	Off(OUT_AC);
	
         turn_left;
	Wait(d_max);
	Off(OUT_AC);
 
	OnRev(OUT_B); Wait(90); // アームを開く
	Off(OUT_B);
	OnFwd(OUT_AC); Wait(50); // ボールをシュート
	OnRev(OUT_AC); Wait(50);
	Off(OUT_AC);
 }

*考察・感想 [#q423d21b]

トップ   新規 一覧 検索 最終更新   ヘルプ   最終更新のRSS