2007b/A5/課題２右

ライントレースロボット†

↑

課題†

　黒い線に沿って走るロボットの製作、ただし以下の事に注意する

1 速さと正確さの追求

2 交差点で優先道路を走ってない場合には、一時停止をする

3 前方にあるロボットと衝突した場合、相手のロボットが離れるのを待つこと

↑

ロボット紹介†

まずキャスターをつけ３輪駆動にする事にした。この方が曲がりやすく回転も容易にできると思ったからだ。

バンパーはシングルバンパーにしてマシンのよけいな部分を剥ぎ落とした。

前輪駆動にすることでセンサの反応が後輪駆動にするより早い。よって小回りを利かせた走行が可能となった。

マシンの形状としては３輪で走る意外はノーマルなタイプとなった。

↑

光センサーの取り付け†

２つの光センサーで黒い線を挟むような『挟み型』を採用。右の光センサが反応することで右に曲がり、左センサが反応することで左に進みます。両方白を感知するときはまっすぐ進むのです。

メリットとして黒線からはみ出たときに反応が早い。比較的楽に曲がる事ができます

デメリットとしては交差点に止まれの線がないと光センサが認識しないという欠点があります。つまり全てのコースに対応するという訳でないということです。

↑

問題†

今回の課題で以下の問題が発生した

1 急なカーブに対応できるか？
2 交差点を通るためのプログラムはどうするか？
3 まっすぐに進まないマシン

１の問題は我々の無計画なコース作りに問題があった。マシンの性能を知らずにコースを作ったので急なカーブ多く、交差点前でもカーブがある。急カーブでマシンが脱線してしまった。

２交差点を通るプログラムは両方のセンサーが同時に白を感知した回数を数え、３数えると元のループに戻るものだったが、交差点の前にカーブがあり停止線に曲がって止まるようになってしまった。そのまま進むと渡った後元のループに戻らなかった。

3我々のマシンはなぜか左に曲がってしまう。

↑

１の問題解決†

まず急カーブの問題を解決するためにモータを密着させマシンの幅を限界まで狭くした。こうする事で小回りを利かすようにしたのである。　　　

また前方に駆動輪を設置することによって後方に設置するよりも早く反応し小回りの良さが上がった。

そしてカーブするときに片方のモーターを止める事で急カーブにも対応できるようにした。　　　　

↑

２の問題解決†

２の問題は白を２回感知した後、ずれていたら修正するようにプログラムを直した。

↑

交差点を渡るプログラム†

x=0;
			while(x<3){
			if(SENSOR_2==1){　　　　　　　　 //タッチセンサーが感知したらループから抜け出します
				break;
				}
				if(SENSOR_1>THRESHOLD&&SENSOR_3>THRESHOLD){　　　　　//黒を感知するまで進みます
	 			until((SENSOR_1<THRESHOLD||SENSOR_3<THRESHOLD)||(SENSOR_2==1));
				x++;　　　　　　　　　　　　　　　　　　　　　　　　　　　　//白を感知した回数を数えます
				}else if(SENSOR_1<THRESHOLD&&SENSOR_3<THRESHOLD){　　　   //白を感知するまで進みます
				if(x<2){
				until((SENSOR_1>THRESHOLD&&SENSOR_3>THRESHOLD)||(SENSOR_2==1));
				}else{
				until((SENSOR_1>THRESHOLD||SENSOR_3>THRESHOLD)||(SENSOR_2==1));
				x++;
				}

↑

片方が交差点の黒線から外れたときの修正プログラム†

else if((SENSOR_1<THRESHOLD&&SENSOR_3> THRESHOLD)&&(x==2)){　　                  //左が感知したら左に曲がります

　Off(OUT_A);

　OnFwd(OUT_C);

until((SENSOR_1>THRESHOLD&&SENSOR_3>THRESHOLD)||(SENSOR_1<THRESHOLD&&SENSOR_3<THRESHOLD)||(SENSOR_2==1));
	 	if(SENSOR_1<THRESHOLD&&SENSOR_3<THRESHOLD){　　　　　　//両方が白を感知するまで進みます
	 	until((SENSOR_1>THRESHOLD&&SENSOR_3>THRESHOLD)||(SENSOR_2==1));
	 				}
	 	x=3;
	 	}else if((SENSOR_1>THRESHOLD&&SENSOR_3<THRESHOLD)&&(x==2)){　//右が感知したら右に曲がります。
		OnFwd(OUT_A);
		Off(OUT_C);
until((SENSOR_1>THRESHOLD&&SENSOR_3>THRESHOLD)||(SENSOR_1<THRESHOLD&&SENSOR_3<THRESHOLD)||(SENSOR_2==1));
		 if(SENSOR_1<THRESHOLD&&SENSOR_3<THRESHOLD){　//両方が白を感知するまで進みます
	 	until((SENSOR_1>THRESHOLD&&SENSOR_3>THRESHOLD)||(SENSOR_2==1));
	 				}
			　　x=3;

こうすることでもし黒線を片方だけ感知しても修正してくれます

↑

３の問題解決†

3の問題は直進できるようにするためにSetPowarをつかいモーターの速度の微調整をする事で解決した。しかしそれでも完全に直進しない

task main(){
     SetPower(OUT_A,7);　//左のモータ出力７
     SetPower(OUT_C,4);   //右のモータ出力４

↑

コース紹介†

コースは全体的にカーブが多く２つの交差点を設けてある(直線がほとんどない)

全体写真

交差点前に急カーブがある。おかげでマシンの性能が問われるようなコースにした

交差点写真

↑

プログラム†

アームセンサが反応した時に以下の３種類の対応を見せる

↑

①３秒間停止して待つ†

Off(OUT_A+OUT_C);
	Wait(300);　　　　//３秒停止

これは衝突後３秒間停止するプログラムの抜粋です。

↑

②その場で１回転だけ３６０度旋回する†

OnFwd(OUT_A);　　　　　　　　　//左モータ正回転
	OnRev(OUT_C);　　　　　　　//右モータ逆回転
	if(SENSOR_3<THRESHOLD){                                                    //もしセンサ３が白を感知していたら
	until(SENSOR_1>THRESHOLD&&SENSOR_3>THRESHOLD);//両方が黒を感知するまで
		}
	until(SENSOR_3<THRESHOLD);
	until(SENSOR_3>THRESHOLD);
	until(SENSOR_3<THRESHOLD);

衝突後１回転します。

↑

③１８０度旋回して５秒間コースを逆走し、再び１８０度旋回してもとの向きに走る†

OnFwd(OUT_A);
	OnRev(OUT_C);
	if(SENSOR_3<THRESHOLD){
	until(SENSOR_1>THRESHOLD&&SENSOR_3>THRESHOLD);
		}
	hurimuki();
		OnFwd(OUT_A);
	 	OnRev(OUT_C);
		until (SENSOR_3<THRESHOLD);
	}

衝突後180度回転し5秒間逆走後元に戻ります。

↑

①②③の複合とプログラムの全体†

#define THRESHOLD 40　　　　　//光感知のための数値です
#define return_time 50　　　　　//５秒戻るための数値です
int x,y=0;
sub hurimuki(){                              //５秒戻るときのサブルーチンです
	until (SENSOR_3<THRESHOLD);
	ClearTimer(0);
	while(Timer(0)<return_time){
	OnFwd(OUT_A);
	OnFwd(OUT_C);
	until(SENSOR_1<THRESHOLD|| SENSOR_3< THRESHOLD );
	if(SENSOR_1<THRESHOLD&&SENSOR_3> THRESHOLD){
	Off(OUT_A);
	OnFwd(OUT_C);
                                                                                      
until((SENSOR_1>THRESHOLD&&SENSOR_3>THRESHOLD)||(SENSOR_1<THRESHOLD&&SENSOR_3<THRESHOLD));
	}else if(SENSOR_1>THRESHOLD&&SENSOR_3<THRESHOLD){
	 OnFwd(OUT_A);
	 Off(OUT_C);
                                                                                       
until((SENSOR_1>THRESHOLD&&SENSOR_3>THRESHOLD)||(SENSOR_1<THRESHOLD&&SENSOR_3<THRESHOLD));
	}else if(SENSOR_3< THRESHOLD&&SENSOR_1< THRESHOLD){
	Off(OUT_A+OUT_C);
	Wait(200);
	OnFwd(OUT_A+OUT_C);
	x=0;
	while(x<3){
	if(SENSOR_2==1){
	break;
	}
	if(SENSOR_1<THRESHOLD&&SENSOR_3<THRESHOLD){
       until((SENSOR_1>THRESHOLD&&SENSOR_3>THRESHOLD));
	          x++;
	}else if(SENSOR_1>THRESHOLD&&SENSOR_3>THRESHOLD){
         until((SENSOR_1<THRESHOLD&&SENSOR_3<THRESHOLD));
	}else if(SENSOR_1<THRESHOLD&&SENSOR_3> THRESHOLD){
           Off(OUT_A);
	OnFwd(OUT_C); 
           
until((SENSOR_1>THRESHOLD&&SENSOR_3>THRESHOLD)||(SENSOR_1<THRESHOLD&&SENSOR_3<THRESHOLD));
	 	x--;
		}else if(SENSOR_1>THRESHOLD&&SENSOR_3<THRESHOLD){
		OnFwd(OUT_A);
		Off(OUT_C);
           until((SENSOR_1>THRESHOLD&&SENSOR_3>THRESHOLD)||(SENSOR_1<THRESHOLD&&SENSOR_3<THRESHOLD));
		x--;
			}
			}
		}
	}
 }
void atattara(){　　　//バンパーにあたったら何をするかです。一周ごとに仕事が違います。
	if(y<=2){
	Off(OUT_A+OUT_C);
	Wait(300);
	}else if(y>2&&y<=4){
	OnFwd(OUT_A);
	OnRev(OUT_C);
	if(SENSOR_3<THRESHOLD){
	until(SENSOR_1>THRESHOLD&&SENSOR_3>THRESHOLD);
		}
	until(SENSOR_3<THRESHOLD);
	until(SENSOR_3>THRESHOLD);
	until(SENSOR_3<THRESHOLD);
	}else {
	OnFwd(OUT_A);
	OnRev(OUT_C);
	if(SENSOR_3<THRESHOLD){
	until(SENSOR_1>THRESHOLD&&SENSOR_3>THRESHOLD);
		}
	hurimuki();
		OnFwd(OUT_A);
	 	OnRev(OUT_C);
		until (SENSOR_3<THRESHOLD);
	}
 }
task main(){
     SetPower(OUT_A,7);
     SetPower(OUT_C,4);
	SetSensor (SENSOR_1,SENSOR_LIGHT);
	SetSensor (SENSOR_3,SENSOR_LIGHT);
	SetSensor(SENSOR_2,SENSOR_TOUCH);
while(true){
		if(SENSOR_2==1){　　　//バンパーが感知すると作動します。いつでも作動します
		atattara();
		}
	 	OnFwd(OUT_A);
	        OnFwd(OUT_C);
　until((SENSOR_1<THRESHOLD|| SENSOR_3< THRESHOLD )||(SENSOR_2==1));//どちらかのセンサーが黒を感知するまで走ります
	 if(SENSOR_1<THRESHOLD&&SENSOR_3> THRESHOLD){
	 Off(OUT_A);
        OnFwd(OUT_C);
               
until((SENSOR_1>THRESHOLD&&SENSOR_3>THRESHOLD)||(SENSOR_1<THRESHOLD&&SENSOR_3<THRESHOLD)||(SENSOR_2==1));
	 }else if(SENSOR_1>THRESHOLD&&SENSOR_3<THRESHOLD){
	 OnFwd(OUT_A);
	 Off(OUT_C);
                
until((SENSOR_1>THRESHOLD&&SENSOR_3>THRESHOLD)||(SENSOR_1<THRESHOLD&&SENSOR_3<THRESHOLD)||(SENSOR_2==1));
		}else if(SENSOR_3< THRESHOLD&&SENSOR_1< THRESHOLD){
	Off(OUT_A+OUT_C);
	Wait(200);
	OnFwd(OUT_A+OUT_C);
	x=0;
	while(x<3){
	if(SENSOR_2==1){          //タッチセンサーが感知したらループから抜け出します
	break;
	}
　if(SENSOR_1>THRESHOLD&&SENSOR_3>THRESHOLD){  　　　　　  //黒を感知するまで進みます
       until((SENSOR_1<THRESHOLD||SENSOR_3<THRESHOLD)||(SENSOR_2==1));
	x++;　　　　　　　　　　　　　　　　　　　　　　　　//白を感知した回数を数えます
　}else if(SENSOR_1<THRESHOLD&&SENSOR_3<THRESHOLD){　　//白を感知するまで進みます
	if(x<2){
	until((SENSOR_1>THRESHOLD&&SENSOR_3>THRESHOLD)||(SENSOR_2==1));
	}else{
	until((SENSOR_1>THRESHOLD||SENSOR_3>THRESHOLD)||(SENSOR_2==1));
	x++;
	}
	}else if((SENSOR_1<THRESHOLD&&SENSOR_3> THRESHOLD)&&(x==2)){　　//左が感知したら左に曲がります
	Off(OUT_A);
	OnFwd(OUT_C);
until((SENSOR_1>THRESHOLD&&SENSOR_3>THRESHOLD)||(SENSOR_1<THRESHOLD&&SENSOR_3<THRESHOLD)||(SENSOR_2==1));//両方が白を感知するまで進みます
	 if(SENSOR_1<THRESHOLD&&SENSOR_3<THRESHOLD){
	 until((SENSOR_1>THRESHOLD&&SENSOR_3>THRESHOLD)||(SENSOR_2==1));
			}
	x=3;
	 }else if((SENSOR_1>THRESHOLD&&SENSOR_3<THRESHOLD)&&(x==2)){　
	 OnFwd(OUT_A);
	 Off(OUT_C);
until((SENSOR_1>THRESHOLD&&SENSOR_3>THRESHOLD)||(SENSOR_1<THRESHOLD&&SENSOR_3<THRESHOLD)||(SENSOR_2==1));
	 if(SENSOR_1<THRESHOLD&&SENSOR_3<THRESHOLD){
	until((SENSOR_1>THRESHOLD&&SENSOR_3>THRESHOLD)||(SENSOR_2==1));　　　　　　　　　　　　　　//両方が感知するまで進みます
		}
	x=3;
	}
　if(x==2){
	y++;
	　}
        }
	}
　}
}

このプログラムは１週するごとにアームセンサの反応する内容が違います。１週目は３秒止まる。２週目は１回転。３週目は１８０度回転後、５秒間逆走し再び元に戻ります。①②③を掛け合わせた走りをします

↑

結果†

他班のロボットと走行させたところバンパーが高すぎ、横の範囲が狭すぎた。これだと相手のバンパーが低すぎると反応できず衝突し、横にも反応できず飛ばされてしまい、コースからはずれてしまう。そこでバンパーの範囲を広くし、バンパーの高さを低くした。

バンパー自体の位置を低くし、下にホースをたらす事で下の範囲を拡大。横にもバンパーの範囲を広くする事で衝突時に飛ばされる事を防いだ。

↑

まとめ†

↑

工夫したところ†

三輪駆動にすることで曲がりやすくしたところ

小回りのきく幅にしたところ

交差点で曲がっても戻るようにしたところ

衝突時の反応が１週ごとに異なること

バンパーの範囲を広くし、かつ横を限りなくスリムにする事で走行中、無駄に他のロボと衝突しなくなった。

↑

苦労したところ†

交差点でずれても修正するプログラムを考えるのがつらかった

コースがカーブだらけなので調整が大変でした

↑

今後の課題†

交差点とS路カーブで衝突してしまうと、修正プログラムを駆使してもコースアウトしてしまう。その確率１００％。この問題をクリアできたら完璧な交通ルールを守るロボットになるだろう。

↑

感想†

コース作りのときもっと計画的に作ればよかったと深く反省する。おかげでプログラム製作が大変だった。バンパーの反応が１週ごとに異なる動作をする。ここが１番の他班のとの違いだと自負する。それと課題発表後新たな問題が発生した。他のロボットと衝突したときにコースアウトしてしまう。僕らの班は、他の班と違いロボットが２台もない。当初完璧だと思っていたこのロボットも問題だらけだという事がわかった。教訓として実際に動かしてみるまで、わからない、何事も過信してはならないという事を学んだ。おかげでマシンの完成度も上がることもできた。次の課題は過信する事なく、貪欲に良いものを創るという気持ちを忘れないでいきたい。　

↑

コメントをどうぞ†

交差点をどのように渡ろうとしているのか、２の問題解決だけからはわかりづらい。白の感知回数を元にしているようですが…なぜそれで交差点を通過できるのかを、きちんと解説してください。　次に、アームセンサが反応したときのプログラムについて書かれていますが、まずアームセンサ(タッチセンサ？)について、どのようにどこに取り付けられているのかが事前に述べられておらず、わかりづらいです。また、プログラム②と③がどのような動作をするのかがよくわからないのですが、もう少し解説を付け加えてください。 -- まいける(TA) 2007-12-14 (金) 08:12:18
初めて見た人にもわかるように、そのバンパーの機構でどのように接触センサーを押しているかの説明がほしいです。 -- クノ 2007-12-15 (土) 20:27:15

ライントレースロボット†

課題†

ロボット紹介†

光センサーの取り付け†

問題†

１の問題解決†

２の問題解決†

交差点を渡るプログラム†

片方が交差点の黒線から外れたときの修正プログラム†

３の問題解決†

コース紹介†

プログラム†

①３秒間停止して待つ†

②その場で１回転だけ３６０度旋回する†

③１８０度旋回して５秒間コースを逆走し、再び１８０度旋回してもとの向きに走る†

①②③の複合とプログラムの全体†

結果†

まとめ†

工夫したところ†

苦労したところ†

今後の課題†

感想†

コメントをどうぞ†

目次

全般

教材・資料

Debian関連

過去の授業

2003年度以前

最新の20件

2007b/A5/課題２右

ライントレースロボット†

課題†

ロボット紹介†

光センサーの取り付け†

問題†

１の問題解決†

２の問題 解決†

交差点を渡るプログラム†

片方が交差点の黒線から外れたときの修正プログラム†

３の問題解決†

コース紹介†

プログラム†

①３秒間停止して待つ†

②その場で１回転だけ３６０度旋回する†

③１８０度旋回して５秒間コースを逆走し、再び１８０度旋回してもとの向きに走る†

①②③の複合とプログラムの全体†

結果†

まとめ†

工夫したところ†

苦労したところ†

今後の課題†

感想†

コメントをどうぞ†

目次

全般

教材・資料

Debian関連

過去の授業

2003年度以前

最新の20件

２の問題解決†