- Äɲ䵤줿¹Ô¤Ï¤³¤Î¿§¤Ç¤¹¡£
- ºï½ü¤µ¤ì¤¿¹Ô¤Ï¤³¤Î¿§¤Ç¤¹¡£
[[2016b/Member]]
[[2016b/Member]]&br;
Ìܼ¡&br;
#contents
*²ÝÂê¤Ë¤Ä¤¤¤Æ [#wf7938bc]
&ref(2016b/Mission2/2016b-mission2.png,50%,¥Þ¥Ã¥×);
&br;
º£²ó¤ÎÌÜɸ¤Ï¡ÖA,P,Q,R,P,S,D¡×¤Î¥ë¡¼¥È¤òÄ̤êD¤Ë¥Ü¡¼¥ë¤ò¥·¥å¡¼¥È¤¹¤ë»ö¤Ç¤¹¡£
*¥×¥í¥°¥é¥à¤Ë¤Ä¤¤¤Æ [#j535e444]
**¥×¥í¥°¥é¥à¤Î²òÀâ [#pbb32be3]
***¸òº¹ÅÀ¤Î¸¡½Ð [#xe8b6c3f]
¸òº¹ÅÀ¤Î¸¡½Ð¤Ë¤Ï¡¢¡Ö¤É¤ÎÈ¿¼ÍΨ¤«¤éȽÄꤹ¤ë¤«¡×¡¢¡Ö¤É¤ì¤°¤é¤¤¤Î´Ö¤½¤ÎÈ¿¼ÍΨ¤¬Â³¤¤¤¿¤«¡×¤Î2¤Ä¤Ë¤è¤Ã¤ÆȽÃǤò¤·¤Æ¤¤¤Þ¤¹¡£¤³¤ÎȽÊ̤ϡ¢¥é¥¤¥ó¥È¥ì¡¼¥¹¤Î¥×¥í¥°¥é¥à¤È¤ÏʬΥ¤·¤Æ¤¤¤Þ¤¹¡£¥é¥¤¥ó¥È¥ì¡¼¥¹¤È¸òº¹ÅÀȽÊ̤¬Ê¬Î¥¤Ç¤¤Æ¤¤¤Ê¤¤¤È¡¢¸òº¹ÅÀ´ð½à¤òÄ´Àᤷ¤¿ºÝ¤Ë¥é¥¤¥ó¥È¥ì¡¼¥¹¤Î´ð½à¤âÊѤï¤Ã¤Æ¤·¤Þ¤¤¤Þ¤¹¡£¤³¤Î2¤Ä¤òʬ¤±¤ë¤³¤È¤Ç¡¢¥é¥¤¥ó¥È¥ì¡¼¥¹¤Î´ð½à¤È¤Ê¤ëÈ¿¼ÍΨ¤È¡¢¸òº¹ÅÀ¤ÎȽÊ̤ò¤¹¤ë¥×¥í¥°¥é¥à¤òʬ¤±¤ë¤³¤È¤¬¤Ç¤¡¢Ä´À᤬´Êñ¤Ë¤Ê¤ê¤Þ¤¹¡£¸òº¹ÅÀ¤Ç¤Ï¡¢¤Û¤È¤ó¤É¥é¥¤¥ó¤ÎÃæ¿´¤Ë°ì»þŪ¤ËÆͤùþ¤ß¤Þ¤¹¡£¤½¤Î°ÙÈ¿¼ÍΨ¤Ï¤«¤Ê¤êÄ㤯¤Ê¤ê¤Þ¤¹¡£
¤è¤Ã¤Æ¡¢È¿¼ÍΨ¤¬Ä㤤¤È¤¤Ë¾¯¤Ê¤¤»þ´Ö¥é¥¤¥È¥»¥ó¥µ¡¼¤¬¤¤¤ë¤È¤¤ò¸òº¹ÅÀ¤È¤¹¤ë¤È¡¢Îɹ¥¤Ë¸òº¹ÅÀ¤òȽÊ̤Ǥ¤Þ¤¹¡£
***¥Ü¡¼¥ë¤Î¸¡½Ð [#wb2100f0]
¥Ü¡¼¥ë¤Î¸¡½Ð¤Ë¤Ï¡¢Ä¶²»ÇÈ¥»¥ó¥µ¡¼¤òÍøÍѤ·¤Þ¤·¤¿¡£Ä¶²»ÇÈ¥»¥ó¥µ¡¼¤Ç¤Ï¡¢Ê¿Ì̤ËÂФ·¤Æ¤ÏÀµ³Î¤ÊÃͤòÊÖ¤·¤Þ¤¹¤¬¡¢¥Ü¡¼¥ë¤Ê¤É¤ÎµåÌ̤䡢ÏѶʤ·¤¿¤â¤Î¤Ç¤¢¤ë¤È¡¢Àµ³Î¤ÊÃͤ¬¼è¤ì¤Þ¤»¤ó¡£
¼ÂºÝ¤Ë¡¢Ëܵ¡¤ÎĶ²»ÇÈ¥»¥ó¥µ¡¼¤ÇÃÏÌ̤ò¸«¤¿»þ¤Ï12cmÄø¤Ç¤¹¤¬¡¢¥Ü¡¼¥ë¤¬Í褿»þ¤Ï20cm°Ê¾å¤È¤Ê¤ê¤Þ¤¹¡£ÃÏÌ̤ÈĶ²»ÇÈ¥»¥ó¥µ¡¼¤Îµ÷Î¥¤Ï¥»¥ó¥µ¡¼¤¬Æ°¤¤¤Æ¤¤¤Ê¤¤¤Î¤Ç¡¢10cm°Ê¾å¤âÃͤ¬¤º¤ì¤ë¤³¤È¤Ï¸½¼ÂŪ¤Ç¤Ï¤¢¤ê¤Þ¤»¤ó¤¬¡¢¥Ü¡¼¥ë¤ò¸¡½Ð¤·¤¿¤é¤«20cm°Ê¾å¤ÈÃͤòÊÖ¤·¤¿¤Î¤Ç¤¹¡£
º£²ó¤Ï¤½¤Î¤è¤¦¤Ê¡¢Àµ³Î¤ÊÃͤ¬Ê֤äƤ³¤Ê¤¤¤³¤È¤òÍøÍѤ·¤Æ¡¢¥Ü¡¼¥ë¤ò¸¡½Ð¤·¤Þ¤·¤¿¡£
***¸òº¹ÅÀ¤Î½èÍý [#b34a19fd]
¸òº¹ÅÀ¤Ç¤Ï¡¢¸òº¹ÅÀ¤Ç¤¢¤ë¤³¤È¤ÎȽÊ̤˻þ´Ö¤ò»È¤Ã¤Æ½èÍý¤ò¤·¤Æ¤¤¤Þ¤¹¡£¤½¤Î°Ù¡¢¸òº¹ÅÀ¤Ç¤¢¤ë¤³¤È¤¬È½ÌÀ¤¹¤ë¤Þ¤Ç¤Ï¡¢¥é¥¤¥ó¥È¥ì¡¼¥¹¤ò¹Ô¤¦¤Î¤Ç¡¤Î¤è¤¦¤ÊÆ°ºî¤ò¤·¤Þ¤¹¡£º£²ó¤Î¥³¡¼¥¹¤Ç¤Ï¡¢6ÈÖÌܤθòº¹ÅÀ°Ê³°¤Ïľ¿Ê¤ò¤·¤Ê¤±¤ì¤Ð¤Ê¤é¤Ê¤¤¤Î¤Ç¡¢¢¤Î½èÍý¤ÇËÜÂΤθþ¤¤òÊѤ¨¤Þ¤¹¡£¤½¤·¤Æ¡¢£¤Çľ¿Ê¤ò¤·¡¢¤¤Ç¥é¥¤¥ó¥È¥ì¡¼¥¹¤ò¤·¤Þ¤¹¡£¤³¤Î»þ¡¢¡¤Î½èÍý¤¬½ª¤ï¤Ã¤¿½Ö´Ö¤ÎËÜÂΤ¬¸þ¤¤¤Æ¤¤¤ëÊý¸þ¤Ë¤Ï¤Ð¤é¤Ä¤¤¬¤¢¤ê¤Þ¤¹¡£¤½¤Î°Ù¡¢£½ªÎ»»þÅÀ¤Ç¤ÎËÜÂΤθþ¤¤â¤Ð¤é¤Ä¤¤¬µ¯¤³¤ë¤¿¤á¡¢¤¤Ç¸òº¹ÅÀ¤ÎȽÊ̤ò¹Ô¤¤¤Ê¤¬¤é¥é¥¤¥ó¥È¥ì¡¼¥¹¤ò¹Ô¤¦¤È¡¢Ï¢Â³¤Ç¸òº¹ÅÀ¤È¸íǧ¤¹¤ë¾ì¹ç¤¬¤¢¤ë¤¿¤á¡¢¤¤Î¥é¥¤¥ó¥È¥ì¡¼¥¹¤Ç¤Ï¡¢1Éô֤ۤɸòº¹ÅÀ¤ÎȽÊ̤Ϥ»¤º¤Ë¥é¥¤¥ó¥È¥ì¡¼¥¹¤ò¹Ô¤¤¤Þ¤¹¡£&br;
&ref(2016b/Member/pen/Mission2/kousatenn.jpeg,50%,¸òº¹ÅÀ¤Î½èÍý);
&ref(2016b/Member/pen/Mission2/kousatenn_1.jpeg,50%,¸òº¹ÅÀ¤Î½èÍý);
***¥·¥å¡¼¥È¤Î½èÍý [#v00cde94]
5¸ÄÌܤθòº¹ÅÀ¡ÊS¡Ë¤òÄ̲á¸å¡¢D¤Ë¸þ¤±¤Æ¥é¥¤¥ó¥È¥ì¡¼¥¹¤ò°ìÄê°Ê¾å¡Ê¼Â¬¤Ç1Éäۤɡ˹Ԥ¨¤Ð¡¢¥é¥¤¥ó¤ÈƱ¤¸¸þ¤¤Ë¤Ê¤ê¤Þ¤¹¡£¤³¤Î»þ¡¢Àµ³Î¤ËÁ°¿Ê¤·¤Ê¤¬¤é¡¢¥Ü¡¼¥ë¤òÎ¥¤»¤Ð¡¢´·À¤Ë¤è¤Ã¤Æ¥·¥å¡¼¥È¤¬¤Ç¤¤ë¡¢¤È¤¤¤¦¸¶Íý¤Ë´ð¤Å¤¥×¥í¥°¥é¥ß¥ó¥°¤ò¤·¤Æ¤¤¤Þ¤¹¡£ÅÅÃÓ»ÄÎ̤˱ƶÁ¤µ¤ì¤Þ¤¹¤¬¡¢¥Ü¡¼¥ë¤òÎ¥¤¹»þ´Ö¤òÄ´À᤹¤ì¤ÐC,D¤Î¥´¡¼¥ë¥¨¥ê¥¢¥é¥¤¥ó¾å¤«¤é¥·¥å¡¼¥È¤¬²Äǽ¤Ç¤¹¡£
**ËÜʸ [#x06b00a6]
#define THRESHOLD 45 //Çò¤È¹õ¤ÎÃæ´Ö¤ÎÈ¿¼ÍΨ
#define SPEED_Fast 60 // ®¤¤¥¹¥Ô¡¼¥É
#define SPEED_Slow 50 // ÃÙ¤¤¥¹¥Ô¡¼¥É
#define OnLR(speedR,speedL) OnRev(OUT_A,speedR);OnRev(OUT_B,speedL); //AB¤ÎÆ°ºîƱ»þ»ØÄê
/*
task pitagora() //¥Ü¡¼¥ë¤ò¼è¤Ã¤¿¤È¤¤Î¥á¥É¥ì¡¼
{
//while(true)
//{
PlayTone(1175,130);
Wait(150);
PlayTone(1318,130);
Wait(300);
PlayTone(1175,140);
Wait(160);
PlayTone(1318,130);
Wait(300);
PlayTone(1568,140);
Wait(160);
PlayTone(1480,130);
Wait(300);
PlayTone(1175,130);
Wait(160);
PlayTone(1318,130);
Wait(300);
PlayTone(988,130);
Wait(150);
PlayTone(880,140);
Wait(310);
PlayTone(988,130);
Wait(150);
PlayTone(1046,140);
Wait(310);
PlayTone(1109,130);
Wait(150);
PlayTone(1175,140);
Wait(460);
PlayTone(1175,130);
Wait(310);
PlayTone(1175,130);
Wait(150);
PlayTone(1318,130);
Wait(310);
PlayTone(1175,130);
Wait(150);
PlayTone(1318,130);
Wait(310);
PlayTone(1568,130);
Wait(150);
PlayTone(1480,130);
Wait(310);
PlayTone(1175,130);
Wait(150);
PlayTone(1318,130);
Wait(310);
PlayTone(1175,130);
Wait(150);
PlayTone(1318,130);
Wait(300);
PlayTone(1175,140);
Wait(160);
PlayTone(1318,130);
Wait(300);
PlayTone(2093,140);
Wait(160);
PlayTone(1975,130);
Wait(300);
PlayTone(1568,140);
Wait(160);
PlayTone(1760,130);
Wait(300);
PlayTone(1175,130);
Wait(150);
PlayTone(1318,140);
Wait(310);
PlayTone(1175,130);
Wait(150);
PlayTone(1318,140);
Wait(310);
PlayTone(1568,130);
Wait(150);
PlayTone(1480,140);
Wait(310);
PlayTone(1175,130);
Wait(150);
PlayTone(1318,130);
Wait(310);
PlayTone(988,130);
Wait(150);
PlayTone(880,440);
Wait(460);
PlayTone(1318,130);
Wait(310);
PlayTone(1318,130);
Wait(150);
PlayTone(1175,440);
Wait(770);
PlayTone(1175,130);
Wait(150);
PlayTone(1318,130);
Wait(300);
PlayTone(1175,140);
Wait(160);
PlayTone(1318,130);
Wait(300);
PlayTone(1568,140);
Wait(160);
PlayTone(1480,130);
Wait(300);
PlayTone(1175,140);
Wait(160);
PlayTone(1318,130);
Wait(300);
PlayTone(1175,130);
Wait(160);
PlayTone(1318,130);
Wait(300);
PlayTone(1175,130);
Wait(150);
PlayTone(1318,140);
Wait(310);
PlayTone(2093,130);
Wait(150);
PlayTone(1975,140);
Wait(310);
PlayTone(1568,130);
Wait(150);
PlayTone(1760,140);
Wait(310);
PlayTone(1175,130);
Wait(150);
PlayTone(1318,130);
Wait(310);
PlayTone(1175,130);
Wait(150);
PlayTone(1318,130);
Wait(310);
PlayTone(1568,130);
Wait(150);
PlayTone(1480,130);
Wait(310);
PlayTone(1175,130);
Wait(150);
PlayTone(1318,130);
Wait(310);
PlayTone(1046,130);
Wait(150);
PlayTone(1175,130);
Wait(300);
PlayTone(1046,140);
Wait(160);
PlayTone(1175,130);
Wait(300);
PlayTone(1397,140);
Wait(160);
PlayTone(1318,130);
Wait(300);
PlayTone(1046,140);
Wait(160);
PlayTone(1175,130);
Wait(300);
PlayTone(932,130);
Wait(160);
PlayTone(1046,130);
Wait(300);
PlayTone(932,130);
Wait(150);
PlayTone(1046,140);
Wait(310);
PlayTone(1244,130);
Wait(150);
PlayTone(1175,140);
Wait(310);
PlayTone(1046,130);
Wait(150);
PlayTone(988,140);
Wait(310);
PlayTone(880,130);
Wait(150);
PlayTone(784,1050);
Wait(1380);
PlayTone(1397,440);
Wait(460);
PlayTone(1318,130);
Wait(300);
PlayTone(1318,140);
Wait(160);
PlayTone(1480,130);
Wait(150);
PlayTone(1318,130);
Wait(150);
PlayTone(1480,140);
Wait(160);
PlayTone(1568,440);
Wait(460);
PlayTone(1175,130);
Wait(300);
PlayTone(988,130);
Wait(160);
PlayTone(1046,130);
Wait(300);
PlayTone(1046,130);
Wait(150);
PlayTone(1175,140);
Wait(160);
PlayTone(1109,130);
Wait(150);
PlayTone(1175,130);
Wait(150);
PlayTone(988,440);
Wait(770);
PlayTone(1397,130);
Wait(150);
PlayTone(1318,130);
Wait(310);
PlayTone(1318,130);
Wait(150);
PlayTone(1480,130);
Wait(150);
PlayTone(1318,140);
Wait(160);
PlayTone(1480,130);
Wait(150);
PlayTone(1568,440);
Wait(460);
PlayTone(1175,130);
Wait(310);
PlayTone(988,130);
Wait(150);
PlayTone(1046,130);
Wait(310);
PlayTone(1046,130);
Wait(150);
PlayTone(1175,130);
Wait(150);
PlayTone(1109,130);
Wait(150);
PlayTone(1175,140);
Wait(160);
PlayTone(988,440);
Wait(760);
PlayTone(1175,140);
Wait(160);
PlayTone(1318,130);
Wait(300);
PlayTone(1175,130);
Wait(150);
PlayTone(1318,140);
Wait(310);
PlayTone(1568,130);
Wait(150);
PlayTone(1480,140);
Wait(310);
PlayTone(1175,130);
Wait(150);
PlayTone(1318,140);
Wait(310);
PlayTone(1175,130);
Wait(150);
PlayTone(1318,130);
Wait(310);
PlayTone(1175,130);
Wait(150);
PlayTone(1318,130);
Wait(310);
PlayTone(1568,130);
Wait(150);
PlayTone(1480,130);
Wait(310);
PlayTone(1175,130);
Wait(150);
PlayTone(1318,130);
Wait(310);
PlayTone(1175,130);
Wait(150);
PlayTone(1318,130);
Wait(310);
PlayTone(1175,130);
Wait(150);
PlayTone(1318,130);
Wait(300);
PlayTone(1568,140);
Wait(160);
PlayTone(1480,130);
Wait(300);
PlayTone(1175,140);
Wait(160);
PlayTone(1318,130);
Wait(300);
PlayTone(1175,140);
Wait(160);
PlayTone(1318,130);
Wait(300);
PlayTone(1175,130);
Wait(160);
PlayTone(1318,130);
Wait(300);
PlayTone(2093,130);
Wait(150);
PlayTone(1975,140);
Wait(460);
PlayTone(1568,140);
Wait(1230);
// }
//}
//task pitagora_owari()
//{
PlayTone(1175,130);
Wait(150);
PlayTone(1318,130);
Wait(310);
PlayTone(1175,130);
Wait(150);
PlayTone(1318,130);
Wait(310);
PlayTone(2093,130);
Wait(150);
PlayTone(1975,130);
Wait(460);
PlayTone(1568,280);
Wait(300);
//}
}
*/
sub line_trace(int sensor_light_lv) //¥é¥¤¥ó¥È¥ì¡¼¥¹¤Î¥×¥í¥»¥¹
{
if (sensor_light_lv < THRESHOLD-8)
{
OnRev(OUT_B,SPEED_Fast);
OnRev(OUT_A,-SPEED_Fast);
}
else if (sensor_light_lv < THRESHOLD-5)
{
OnRev(OUT_B,SPEED_Slow);
}
else if (sensor_light_lv < THRESHOLD +5)
{
OnRev(OUT_AB,50);
}
else if (sensor_light_lv < THRESHOLD+8)
{
OnRev(OUT_A,SPEED_Slow);
}
else
{
OnRev(OUT_A,SPEED_Fast);
OnRev(OUT_B,-SPEED_Fast);
}
}
sub go_forward_intersection() //¸òº¹ÅÀ¤òÄ̲᤹¤ë¢¤ÎÁàºî
{
OnRev(OUT_AB,SPEED_Slow);
Wait(410);
Off(OUT_AB);
}
sub turn_r_intersection() //¸òº¹ÅÀ¤Î±¦¤Ë¼ÖÂΤò¸þ¤«¤»¤ë
{
OnLR(60,-60);
Wait(450);
}
sub turn_l_intersection() // ¸òº¹ÅÀ¤Îº¸¤Ë¼ÖÂΤò¸þ¤«¤»¤ë
{
OnLR(-60,60);
Wait(450);
} //¥Ü¡¼¥ë¤ò¼è¤ëÆ°ºî
sub arm_lock()
{
Off(OUT_ABC);
OnRev(OUT_AB,25);
OnFwd(OUT_C,-12);
Wait(3200);
Off(OUT_ABC);
}
sub arm_unlock() //¥¢¡¼¥à¤ò¾å¤²¡¢¥Ü¡¼¥ë¤ò¼«Í³¤Ë¤¹¤ë
{
OnFwd(OUT_C,30);
}
long intersection_judgment(long t0) //Sensor¤ÎÃͤ¬34(Ǥ°Õ¤ÎÈ¿¼ÍΨ)°Ê¾å¤Î¤È¤¡¢°ú¿ô¤Ë¸½ºß¤Î»þ¹ï¤òÂåÆþ¤·ÊÖ¤¹¡£¤½¤ì°Ê³°¤ÏÊѹ¹¤»¤º°ú¿ô¤òÊÖ¤¹¡£
{
if (SENSOR_1 > 34)
{
t0 = CurrentTick();
}
return t0 ;
}
task main()
{
SetSensorLight(S1); // ¥é¥¤¥È¥»¥ó¥µ¡¼¤ÎÄêµÁ
SetSensorLowspeed(S2); //Ķ²»ÇÈ¥»¥ó¥µ¡¼¤ÎÄêµÁ
int intersection_count = 0; //¸òº¹ÅÀ¤Î¥«¥¦¥ó¥ÈÊÑ¿ô¤ÎÄêµÁ
int count_look=0; //¥Ü¡¼¥ë¤òÄϤó¤Ç¤¤¤ë¤«¤ÎÊÑ¿ô¤ÎÄêµÁ
long t0 = CurrentTick(); //»þ´Ö¤òµ²±¤¹¤ëÊÑ¿ô¤ÎÄêµÁ
RotateMotor(OUT_AB,SPEED_Slow,-1000); //¥¹¥¿¡¼¥ÈÃÏÅÀ¤«¤éÁ°¿Ê¤¹¤ë
while(CurrentTick()-t0 < 6000) //Á°¿Ê¤«¤é6ÉäۤɡÊ̵¾ò·ï¡Ë¥é¥¤¥ó¥È¥ì¡¼¥¹¤ò¤¹¤ë¤³¤È¤Ç¡¢³Î¼Â¤ËÀþ¾å¤Ë¾è¤ë
{
line_trace(SENSOR_1); //¥é¥¤¥ó¥È¥ì¡¼¥¹¤ò¸Æ¤Ó½Ð¤¹
}
t0 = CurrentTick(); // ¸òº¹ÅÀ¤ÎȽÄê¤ò»Ï¤á¤ë¤¿¤á¤Ë¥¿¥¤¥Þ¡¼¤ò¥ê¥»¥Ã¥È
while(true)
{
//NumOut(0,0,SensorUS(S2) , true);
while(CurrentTick()-t0 < 410) //»ØÄꤷ¤¿È¿¼ÍΨ¡Êintersection_judgment¤Ë¤è¤ë½èÍý¡Ë¤¬¡¢410(Ǥ°Õ¤Î»þ´Ö)Ϣ³¤Ç¤Ê¤±¤ì¤Ð¡¢·«¤êÊÖ¤¹
{
line_trace(SENSOR_1);
t0=intersection_judgment(t0);
}
PlaySound(SOUND_UP); //¥ë¡¼¥×¤òÈ´¤±¤¿¡Ê¸òº¹ÅÀ¤Î½èÍý¤¬»Ï¤Þ¤ë¡Ë¤È¤¡¢²»¤òÌĤ餹
Off(OUT_AB); //¼ÖÂΤÎÄä»ß
Wait(1000);
intersection_count +=1; //¸òº¹ÅÀ¤ò¥«¥¦¥ó¥È¤¹¤ë
if (intersection_count <=5 ) //¸òº¹ÅÀ¤¬5²ó°ÊÆâ¤Î¤È¤¤Î½èÍý
if (intersection_count <=4 ) //¸òº¹ÅÀ¤¬4²ó°ÊÆâ¤Î¤È¤¤Î½èÍý
{
turn_r_intersection(); //¢¤Î½èÍý
go_forward_intersection(); //£¤Î½èÍý
t0 = CurrentTick(); //¥¿¥¤¥Þ¡¼¤ò¥ê¥»¥Ã¥È
while(CurrentTick()-t0 < 1000) //¤¤Î½èÍý¡Ê1Éô֥饤¥ó¥È¥ì¡¼¥¹¤ò¤¹¤ë¡Ë
{
line_trace(SENSOR_1);
}
if (intersection_count ==2) //2²ó¤á¤Î¸òº¹ÅÀ¤Î¤È¤
{
RotateMotor(OUT_AB,SPEED_Slow,500); //¸å¤í¤Ë¡ÊÀµ³Î¤Ë¡Ë²¼¤¬¤ë
while(SensorUS(S2)<=20) //Ķ²»ÇÈ¥»¥ó¥µ¡¼¤¬20cm°ÊÆâ¤Î¤È¤¥ë¡¼¥×
{
OnRevSync(OUT_AB,40,0); //Àµ³Î¤ËÁ°¿Ê
}
arm_lock(); //¥Ü¡¼¥ë¤Î¼èÆÀ
//start pitagora ; //¥á¥í¥Ç¥£¤òή¤¹
}
}
else if (intersection_count ==6 ) //¾å¤Î¥×¥í¥°¥é¥à¤Îgo_forward_intersection¤Ë¾ò·ï¼°¡Öif (intersection_count !=6 )¡×¤ò¤Ä¤±¤ì¤Ð¡¢¥³¥ó¥Ñ¥¯¥È¤Ë¤Ï¤Ê¤ë¤¬¡¢¥·¥å¡¼¥È¤Î½èÍý¤ÏÄ´À᤬ɬÍפʤΤÇʬΥ
else if (intersection_count ==5 ) //¾å¤Î¥×¥í¥°¥é¥à¤Îgo_forward_intersection¤Ë¾ò·ï¼°¡Öif (intersection_count !=5 )¡×¤ò¤Ä¤±¤ì¤Ð¡¢¥³¥ó¥Ñ¥¯¥È¤Ë¤Ï¤Ê¤ë¤¬¡¢¥·¥å¡¼¥È¤Î½èÍý¤ÏÄ´À᤬ɬÍפʤΤÇʬΥ
{
turn_l_intersection();
t0 = CurrentTick();
while(CurrentTick()-t0 < 1500) //¥é¥¤¥ó¥È¥ì¡¼¥¹¤Ç¥é¥¤¥ó¤Ë³Î¼Â¤Ë¾è¤ë
{
line_trace(SENSOR_1);
}
Off(OUT_AB); //Á°¿Ê¤·¤Ê¤¬¤é¡¢¥Ü¡¼¥ë¤òÎ¥¤·¡¢´·À¤Ë¤è¤Ã¤Æ¥·¥å¡¼¥È¤¹¤ë
OnRevSync(OUT_AB,40,0);
arm_unlock();
Wait(1500);
Off(OUT_ABC);
break; //¥×¥í¥°¥é¥à¤Î½ªÎ»
}
t0 = CurrentTick();
}
}