2017a/Member/sawa/Mission2 の履歴ソース(No.3)

• 履歴一覧
• 差分 を表示
• 現在との差分 を表示
• 2017a/Member/sawa/Mission2 へ行く。
  • 1 (2017-07-06 (木) 09:18:04)
  • 2 (2017-07-06 (木) 14:07:07)
  • 3 (2017-07-07 (金) 12:20:06)

[[2017a/Member]]
#contents
*課題について [#a519caec]
#ref(./2017a-mission2.png,80%,課題)
**右折ルート [#y0d1034e]
*ロボットについて [#je0a9760]
*プログラムについて [#g50bed2d]
**defineとsubrutine [#c6aa0b20]
***define [#j5028005]
色について定義する。
 #define white 50                 //白色

 #define white_gray 48　　　　　　 //白灰色

 #define gray 40                  //灰色

 #define black_gray 37            //黒灰色

 #define black 35                 //黒色

簡単な動きについて定義する。
 #define go_forward OnFwd(OUT_AC);                 //直進する

 #define turn_left0 Off(OUT_A);OnFwd(OUT_C);       //左旋回する

 #define turn_left1 OnRev(OUT_A);OnFwd(OUT_C);     //左回転する

 #define turn_right0 Off(OUT_C);OnFwd(OUT_A);      //右旋回する

 #define turn_right1 OnRev(OUT_C);OnFwd(OUT_A);    //右回転する


***subrutine [#x123b074]
 sub walk_right()
 {
 ClearTimer(0);
 while(FastTimer(0)<15)
 if(SENSOR_2>white_gray){
 turn_left1;
 ClearTimer(0);
 }
 else if(SENSOR_2>gray){
 turn_left0;
 ClearTimer(0);
 }
 else if(SENSOR_2>black_gray){
 go_forward;
 ClearTimer(0);
 }
 else if(SENSOR_2>black){
 turn_right0;
 ClearTimer(0);
 }
 else{
 turn_right1;
 }
 Off(OUT_AC);
 }

 sub walk_left()
 {
 ClearTimer(0);
 while(FastTimer(0)<15)
 if(SENSOR_2>white_gray){
 turn_right1;
 ClearTimer(0);
 }
 else if(SENSOR_2>gray){
 turn_right0;
 ClearTimer(0);
 }
 else if(SENSOR_2>black_gray){
 go_forward;
 ClearTimer(0);
 }
 else if(SENSOR_2>black){
 turn_left0;
 ClearTimer(0);
 }
 else{
 turn_left1;
 }
 Off(OUT_AC);
 }

 task main()
 {
   SetSensor(SENSOR_2,SENSOR_LIGHT);

 walk_right();
 PlaySound(SOUND_UP);
 OnFwd(OUT_AC);
 Wait(30);
 Off(OUT_AC); 

 walk_left();
 PlaySound(SOUND_DOWN);
 Wait(100);
 OnFwd(OUT_C);
 Wait(150);
 Off(OUT_AC); 

 walk_left();
 PlaySound(SOUND_UP);
 OnFwd(OUT_AC);
 Wait(50);
 Off(OUT_AC); 

 walk_left();
 Off(OUT_AC);
 PlaySound(SOUND_UP);
 OnFwd(OUT_AC);
 Wait(50);
 Off(OUT_AC);

 walk_right();
 PlaySound(SOUND_DOWN);
 Wait(100);
 OnFwd(OUT_AC);
 Wait(50);
 Off(OUT_AC); 

 walk_right();
 PlaySound(SOUND_DOWN);
 Wait(100);
 OnFwd(OUT_AC);
 Wait(50);
 Off(OUT_AC); 

 walk_right();
 PlaySound(SOUND_UP);
 OnFwd(OUT_A);
 Wait(280);
 Off(OUT_AC);

 ClearTimer(0);
 while(FastTimer(0)<30)
 if(SENSOR_2>white_gray){
 turn_left1;
 ClearTimer(0);
 }
 else if(SENSOR_2>gray){
 turn_left0;
 ClearTimer(0);
 }
 else if(SENSOR_2>black_gray){
 go_forward;
 ClearTimer(0);
 }
 else if(SENSOR_2>black){
 turn_right0;
 ClearTimer(0);
 }
 else{
 turn_right1;
 }
 Off(OUT_AC);
 OnFwd(OUT_A);
 Wait(270);
 walk_right();
 PlaySound(SOUND_UP);
 OnFwd(OUT_AC);
 Wait(30);
 Off(OUT_AC); 

 walk_left();
 PlaySound(SOUND_DOWN);
 Wait(100);
 OnFwd(OUT_C);
 Wait(150);
 Off(OUT_AC); 

 walk_left();
 PlaySound(SOUND_UP);
 OnFwd(OUT_AC);
 Wait(50);
 Off(OUT_AC);

 walk_left();
 PlaySound(SOUND_UP);
 OnFwd(OUT_AC);
 Wait(50);
 Off(OUT_AC);

 walk_right();
 PlaySound(SOUND_UP);
 OnFwd(OUT_A);
 Wait(280);
 Off(OUT_AC);

 walk_right();
 PlaySound(SOUND_DOWN);
 }