[[2006a/C3/課題2左]]
**プログラム(作成途中) [#d31eff49]
#define THRESHOLD 40
task main()
{
SetSensor(SENSOR_3,SENSOR_LIGHT);
SetSensor(SENSOR_1,SENSOR_LIGHT);
SetSensor(SENSOR_2,SENSOR_TOUCH);
OnFwd(OUT_A+OUT_C);
while(true){ //もしセンサーが黒いところに当たった if // まっすぐ進む
while(true){ //もしセンサーが黒いところに当たった if //とき曲がってまっすぐ進む
OnRev(OUT_A);
OnFwd(OUT_C);
}
else
{
Off(OUT_A+OUT_C);
OnFwd(OUT_A+OUT_C);
}
}
while(true){
if
{
(SENSOR_3<THRESHOLD); //
OnRev(OUT_C);
OnFwd(OUT_A);
}
else {
Off(OUT_A+OUT_C);
OnFwd(OUT_A+OUT_C);
}
}
while(true) //ぶつかったとき右回りで避ける
{
OnRev(OUT_A); OnFwd(OUT_C); Wait(40);
Off(OUT_A+OUT_C); OnFwd(OUT_A+OUT_C); Wait(40);
OnRev(OUT_C);OnFwd(OUT_A);Wait(40);
}
{
(SENSOR_1<THRESHOLD);