- 追加された行はこの色です。
- 削除された行はこの色です。
[[2016a/Member]]
*課題2 ライントレース [#hee4f6c3]
**目次 [#p3cf045b]
#contents
**ロボット本体の説明 [#ebe8cc83]
ロボットに関しては説明書の通りに作った。
二つのモーターをつないだ前輪と、モーターをつないでいない後輪を基礎として、前方に光センサーをつけた。
また、右側のタイヤはAに、左のタイヤはCに、光センサーは1に接続した。
#ref(robo2f2.png)
#ref(robo2f3.png)
**コース [#nbd78af3]
下図の右上からスタートして
左上のゴールへと赤い線の通りに進むコースである
#ref(robo2f4.png)
**プログラムの説明 [#zffc4154]
***定義のプログラミング [#ia63d7a2]
#define THRESHOLD 45
#define SPEED_HIGH 35
#define SPEED_LOW 30
#define turn_left OnFwd(OUT_A,SPEED_HIGH);Off(OUT_C);
#define turn_left1 OnRev(OUT_C,SPEED_LOW);OnFwd(OUT_A,SPEED_LOW);
#define turn_right Off(OUT_A);OnFwd(OUT_C,SPEED_HIGH);
#define turn_right1 OnRev(OUT_A,SPEED_LOW);OnFwd(OUT_C,SPEED_LOW);
#define turn_right2 OnFwd(OUT_A,50);OnFwd(OUT_C,10);Wait(200);Off(OUT_AC);
#define STEP 1
#define nMax 140
#define short_break Off(OUT_AC);Wait(1000);
#define go_forward OnFwd(OUT_AC,SPEED_HIGH);
***main以下 [#l10113c6]
task main ()
{
SetSensorLight(S1);
int nOnline=0;
long t0 = CurrentTick();
SetSensorLight(S1);
int nOnline=0;
long t0 = CurrentTick();
while(CurrentTick()-t0<33000) //33秒間続ける
{
while (nOnline < nMax) {
if (SENSOR_1 < THRESHOLD-10) { //左旋回、カウンターを増やす
turn_left1;
nOnline++;
}
else if (SENSOR_1 < THRESHOLD-7) { //左折
turn_left;
nOnline=0;
} else if (SENSOR_1 < THRESHOLD+7) { //前進
go_forward;
nOnline=0;
} else if (SENSOR_1 < THRESHOLD+15) { //右旋回
turn_right1;
nOnline=0;
} else { //その他の場合は右折
turn_right;
nOnline=0;
}
Wait(STEP);
}
PlaySound(SOUND_UP); // 高くなる音
short_break; //1秒間の停止
OnFwd(OUT_C,50);
OnFwd(OUT_A,10);
Wait(300);
Off(OUT_AC); //右へ旋回する
PlaySound(SOUND_DOWN); // 低くなる音
nOnline=0;
}
Wait(2000);
PlaySound(SOUND_UP); // 高くなる音
while(CurrentTick()-t0<33000) //33秒間続ける
{
while (nOnline < nMax) {
if (SENSOR_1 < THRESHOLD-10) { //左旋回、カウンターを増やす
turn_left1;
nOnline++;
}
else if (SENSOR_1 < THRESHOLD-7) { //左折
turn_left;
nOnline=0;
}
else if (SENSOR_1 < THRESHOLD+7) { //前進
go_forward;
nOnline=0;
}
else if (SENSOR_1 < THRESHOLD+15) { //右旋回
turn_right1;
nOnline=0;
}
else { //その他の場合は右折
turn_right;
nOnline=0;
}
Wait(STEP);
}
PlaySound(SOUND_UP); // 高くなる音
short_break; //1秒間の停止
OnFwd(OUT_C,50);
OnFwd(OUT_A,10);
Wait(300);
Off(OUT_AC); //右へ旋回する
PlaySound(SOUND_DOWN); // 低くなる音
nOnline=0;
}
Wait(2000);
PlaySound(SOUND_UP); // 高くなる音
while(true){
while (nOnline < nMax) {
if (SENSOR_1 < THRESHOLD-10) { //左旋回、カウンターを増やす
turn_left1;
nOnline++;
}
else if (SENSOR_1 < THRESHOLD-7) { //左折
turn_left;
nOnline=0;
} else if (SENSOR_1 < THRESHOLD+7) { //前進
go_forward;
nOnline=0;
} else if (SENSOR_1 < THRESHOLD+15) { //右旋回
turn_right1;
nOnline=0;
} else { //その他の場合は右折
turn_right;
nOnline=0;
}
Wait(STEP);
}
PlaySound(SOUND_UP); // 高くなる音
short_break; //1秒間の停止
turn_right2;
PlaySound(SOUND_DOWN); // 低くなる音
nOnline=0;
}
while(true){
while (nOnline < nMax) {
if (SENSOR_1 < THRESHOLD-10) { //左旋回、カウンターを増やす
turn_left1;
nOnline++;
}
else if (SENSOR_1 < THRESHOLD-7) { //左折
turn_left;
nOnline=0;
}
else if (SENSOR_1 < THRESHOLD+7) { //前進
go_forward;
nOnline=0;
}
else if (SENSOR_1 < THRESHOLD+15) { //右旋回
turn_right1;
nOnline=0;
}
else { //その他の場合は右折
turn_right;
nOnline=0;
}
Wait(STEP);
}
PlaySound(SOUND_UP); // 高くなる音
short_break; //1秒間の停止
turn_right2;
PlaySound(SOUND_DOWN); // 低くなる音
nOnline=0;
}
}
***工夫した点 [#m9d3473b]
ところどころ音を鳴らすことでプログラムが間違っていないか確認できたことは良かった
また、光センサーの基準の値を定義することで変更する箇所を減らせたのも良かった。
***反省点 [#x8174140]
どうしてもサブルーチンができなかった。
そのまま、サブルーチンのなかに入れてもエラーが起こってしまい直すことができなかった。
次の課題をするときには使いこなせるようにしたい。
**考察・まとめ [#a4620892]
***良かった点 [#lc12a723]
高い確率でゴールまで行けたことは良かった。
また、図を協力してきれいに描けたので誤作動がほとんどなかったのは良かったと思う。
***悪かった点 [#b2b5535a]
ゴールまではたどり着けたのだが、サブルーチンなど使いこなせていないプログラミングの要素があったのは反省点であると思う。
次の課題に向けて克服していければ良いなと思う。