#contents *²ÝÂê¤Ë¤Ä¤¤¤Æ [#s0021a84] ²ÝÂꣳ¤Ï¥³¡¼¥¹¾å¤Ë¤¢¤ë¥«¥ó¤òGOAL¤ÎÎΰè¤ËÀѤ߾夲¤ë¤È¤¤¤¦¤â¤Î¤Ç¤¢¤ë¡£ #ref(./course.png,70%) ¿Þ¤Î¥Ô¥ó¥¯¤Î´Ý¤Ë¥«¥ó¤¬ÃÖ¤«¤ì¤Æ¤ª¤ê¡¢¤½¤ì¤òGOAL¤Þ¤Ç±¿¤ó¤ÇÀѤó¤Ç¤¤¤¯¡£ &br;¾Ü¤·¤¯¤Ï[[²ÝÂê3>http://yakushi.shinshu-u.ac.jp/robotics/?2017a/Mission3]]¤ò»²¾È¤·¤Æ¤¯¤À¤µ¤¤¡£ *Êý¿Ë [#t398f1eb] Ëͤ¿¤Á¤ÎÈɤϥ«¥ó¤òÀѤতȥ«¥ó¤ò½¸¤á¤ÆGOAL¤Þ¤Ç±¿¤Ö¦¤Î£²ÂΤËʬ¤±¤Æ¤ä¤ë¤³¤È¤Ë¤·¤¿¡£ **ÀѤঠ[#d5550744] ¡-ÀѤতϺǽé¤Ë¥í¡¼¥¿¥ê¡¼¤«¤é¥¹¥¿¡¼¥È¤·¤Æ¡¢TÃÏÅÀ¤Î¥«¥ó¤òÄϤó¤ÇÂÔµ¡¤·¤Æ¤ª¤¯¡£ &br;¢-bluetooth¤Î¿®¹æ¤¬Í褿¤é¡¢¥«¥ó¤òÀѤࡣ &br;£-ÀѤޤ줿¥«¥ó¤Î°ìÈÖ²¼¤òÄϤó¤Ç»ý¤Á¾å¤²¤ÆÂÔµ¡ &br;°Ê²¼¢¡¢£¤ò·«¤êÊÖ¤·¡£ **½¸¤á¤ë¦ [#f4bf7df8] ¡-¥«¥ó¤ò½¸¤á¤ÆGOALÃÏÅÀ¤ËÆϤ±¤ë¡£ &br;¢-ÀѤত˿®¹æ¤òÁ÷¤ë¡£ &br;°Ê²¼¡¡¢¢¤ò·«¤êÊÖ¤·¡£ *µ¡ÂΤˤĤ¤¤Æ [#la04f93e] **ÀѤঠ[#g1f48a96] #ref(./stack_arm.jpg,left,around,20%) ¥«¥ó¤òÄϤॢ¡¼¥à¤Ï¾å¿Þ¤Î¤è¤¦¤Ê¤â¤Î¤òÀ©ºî¤·¤¿¡£ &br;¥â¡¼¥¿¡¼¤Î²óž¤ÇÄϤó¤ÇÊü¤¹Æ°ºî¤¬¤Ç¤¤ë¡£ &br;¥¢¡¼¥à¤ò¾å²¼¤µ¤»¤ë¤³¤È¤Ç¥«¥ó¤òÀѤàÆ°ºî¤¬²Äǽ¤Ë¤Ê¤ë #clear &br; #ref(./stack.jpg,left,around,25%) ¾å¤Î¥¢¡¼¥à¤ò¾å²¼¤ËÆ°¤«¤»¤ë¤è¤¦¤Ë¤·¤¿ºÇ½ªÅª¤Êµ¡ÂΤ¬¤³¤ì¡£ &br;»Í³Ñ·Á¤òÊÑ·Á¤µ¤»¤ë¤è¤¦¤Ë¤·¤Æ¥¢¡¼¥à¤ò¾å²¼¤µ¤»¤Æ¤¤¤ë¡£ &br;¥«¥ó¤òÀѤȤ¤Ë¥¢¡¼¥à¤ò¿åÊ¿¥ó¤ËÊݤĤ¿¤á¡¢¤³¤Îµ¡¹½¤òºÎÍѤ·¤¿¡£ &br;¥â¡¼¥¿¤Ç¥¢¡¼¥à¤ò¾å²¼¤µ¤»¤ë¤¬¡¢¤½¤Î¤Þ¤Þ¤Ç¤Ï²ó¤é¤Ê¤«¤Ã¤¿¤¿¤á¡¢¥®¥¢¤ò¤«¤Þ¤»¤Æ²óž¤µ¤»¤Æ¤¤¤ë¡£ &br;¥¢¡¼¥à¤ò²¼¤Ë²¼¤²Àڤ俤Ȥ¤ËÁ°¤Ë¤Ä¤ó¤Î¤á¤Ã¤Æ¤·¤Þ¤Ã¤¿¤¿¤á¡¢¥¿¥¤¥ä¤ÎÁ°¤Ë¤Ä¤Ã¤«¤¨¤ò¼è¤êÉÕ¤±¤¿ #clear **½¸¤á¤ë¦ [#sb42d88e] #ref(./collect.jpg,left,around,25%) ¥µ¥ó¥×¥ë¤Îµ¡ÂΤò¥Ù¡¼¥¹¤Ë¤·¤ÆÀ©ºî¤·¤¿¡£ &br;¥é¥¤¥ó¥È¥ì¡¼¥¹¤ò¤Ê¤¬¤é¥«¥ó¤ò¤¢¤Ä¤á¤ë¤Î¤Çµ¡ÂÎÁ°Êý¤Ë¸÷¥»¥ó¥µ¤ò¼è¤êÉÕ¤±¤¿¡£ &br;¥«¥ó¤òÊÝ»ý¤·¤Ê¤¬¤é¿Ê¤à¤¿¤á¡¢¥¢¡¼¥à¤ò¼è¤êÉÕ¤±¤¿¡£¤Þ¤¿¡¢Åݤì¤Ê¤¤¤è¤¦¤Ë¥¢¡¼¥à¤ËÉý¤ò»ý¤¿¤»¤¿¡£ #clear *¥×¥í¥°¥é¥à¤Ë¤Ä¤¤¤Æ [#a1a8321f] ËͤÏÀѤàÊý¤Î¥×¥í¥°¥é¥à¤òôÅö¤·¤¿¡£ &br;½¸¤á¤ëÊý¤Î¥×¥í¥°¥é¥à¤Ï[[&size(18){mattu};>2017a/Member/mattu/Mission2]]¤ò»²¾È¤·¤Æ¤¯¤À¤µ¤¤¡£ &br;¥×¥í¥°¥é¥àÁ´Ê¸¤Ï[[&size(18){¤³¤Á¤é};>./code]]¤ò»²¾È¤·¤Æ¤¯¤À¤µ¤¤ **ÊÑ¿ôÀë¸À[#w913c460] //A¡¦¡¦¡¦Â²ó¤ê B¡¦¡¦¡¦¥¢¡¼¥à¾å²¼ C¡¦¡¦¡¦¥¢¡¼¥à #define CONN 0 #define INBOX MAILBOX3 #define ang_up 340 //»ý¤Á¾å¤²ÍѳÑÅÙ #define ang_put 80 //¥«¥óÃÖ¤¯³ÑÅÙ #define ANGLE 50 //ÄϤàÍѳÑÅÙ #define POWER 30 //ÀµÅ¾ #define POWER_LEGS 40 //²ó¤êÍÑ #define POWER_RE -30 //µÕž °ìÈÖ¾å¤Ë¤É¤ÎÆ°ºî¤Ë¤É¤Î¥â¡¼¥¿¤ò³ä¤êÅö¤Æ¤ë¤«¤ò½ñ¤¤¤Æ¤¤¤Þ¤¹¡£ &br;¥³¥á¥ó¥Èʸ¤ÇÀâÌÀ¤Ç¤¤Æ¤¤¤ë¤È»×¤¦¤Î¤ÇÀâÌÀ¤Ï¾Êά¤¹¤ë¡£ **¥µ¥Ö¥ë¡¼¥Á¥ó¤Ë¤Ä¤¤¤Æ[#w913c460] sub go_f(int l){ //»ØÄêµ÷Î¥Á°¿Ê float Ang=l*2.0463; //²óž³ÑÅÙ·×»» RotateMotor(OUT_A,POWER_LEGS,Ang); //Á°¿Ê Off(OUT_A); } ¤³¤ì¤Ë¤Ä¤¤¤Æ¤Ï[[&size(18){²ÝÂ꣱};>2017a/Member/kiryu/Mission1]]¤ò»²¾È¤·¤Æ¤¯¤À¤µ¤¤¡£ sub hold(){ //¥«¥ó¤òÄϤà sub hold(){ //¥«¥ó¤òÄϤà go_f(100); //Á°¿Ê¤·¤Æ¥«¥ó¤Î°ÌÃÖ¤ò¹ç¤ï¤»¤ë RotateMotor(OUT_C,POWER_RE,ANGLE); ¡¡¡¡¡¡¡¡//¥«¥óÄϤà } sub stack(){ //¥«¥ó¤òÀѤà go_f(170); //Á°¿Ê¤·¤Æ¥«¥ó¤Î°ÌÃÖ¤ò¹ç¤ï¤»¤ë go_f(-10); //¥«¥ó¤«¤éÎ¥¤ì¤Æ°ÌÃÖÄ´À° RotateMotor(OUT_B,POWER_RE,ang_put); //¥«¥ó¤òÃÖ¤¯(ÀѤà) } ¤³¤ì¤é¤Ï¥³¥á¥ó¥Èʸ¤ÇÀâÌÀ¤Ç¤¤Æ¤¤¤ë¤È»×¤¦¤Î¤Ç¾Êά sub down_arm(){ //¥¢¡¼¥à¤ò²¼¤²¤ë OnFwd(OUT_B,POWER_RE); Wait(1100); Off(OUT_B); } ¥¢¡¼¥à¤ò²¼¤²¤ë´Ø¿ô¡£ &br;¥¢¡¼¥à¤ò²¼¤Ë1100¥ß¥êÉò¼¤²¤ë¡£¤³¤³¤Ï³ÑÅÙ¤è¤ê¤â»þ´Ö¤ÇÀ©¸æ¤·¤¿¤Û¤¦¤¬³Î¼Â¤Ë²¼¤¬¤ë¤¿¤á¡¢»þ´Ö¤ÇÀ©¸æ¤·¤Æ¤¤¤ë¡£ **¥á¥¤¥ó¥¿¥¹¥¯ [#k6b91c8e] task main(){ int msg=0; until(BluetoothStatus(CONN)==NO_ERR);¡¡¡¡¡¡¡¡¡¡¡¡¡¡¡¡¡¡¡¡¡¡¡¡¡¡ //bluetooth¤¬³ÎΩ¤¹¤ë¤Þ¤ÇÂÔµ¡ go_f(-50); //¥¢¡¼¥à¤ò²¼¤²¤ë¤¿¤á¤Î°ÌÃÖÄ´À° down_arm(); //¥¢¡¼¥à¤ò²¼¤²¤Æ¥«¥ó¤òÄϤà½àÈ÷ while(1){ hold(); //¥«¥óÄϤà OnFwd(OUT_C,POWER_RE); ¡¡¡¡¡¡¡¡//ÊÝ»ý¤·Â³¤±¤ë RotateMotor(OUT_B,50,ang_up); ¡¡¡¡¡¡¡¡¡¡¡¡¡¡¡¡//»ý¤Á¾å¤²¤ë go_f(-150); //°ÌÃÖÄ´À° ReceiveRemoteNumber(MAILBOX3,true,msg); //½¸¤á¤ë¦¤«¤é¤Î¿®¹æ¤¬Íè¤ë¤Þ¤ÇÂÔµ¡ while(msg!=2){ ReceiveRemoteNumber(MAILBOX3,true,msg); Wait(10); } stack(); //£²¤Î¿®¹æ¤¬Í褿¤éÀѤà Off(OUT_C); //¥«¥ó¤òÊÝ»ý¤¹¤ëÎϤòÈ´¤¯ RotateMotor(OUT_C,POWER,ANGLE); //¥«¥óÎ¥¤¹ go_f(-100); //°ÌÃÖÄ´À° down_arm(); //¥¢¡¼¥à¤ò²¼¤²¤Æ¼¡¤Î½àÈ÷ } } *·ë²Ì [#d01e2c46] ¼ÂºÝ¤Îȯɽ¤Ç¤Ï½¸¤á¤ë¦¤Î¥×¥í¥°¥é¥à¤¬´Ö¤Ë¹ç¤ï¤Ê¤«¤Ã¤¿¤¿¤á¡¢ÀѤळ¤È¤ò¤¢¤¤é¤á¤Æ¥«¥ó¤òGOAL¤ÎÎΰè¤Ë±¿¤Ö¤³¤È¤Ë¤Ê¤Ã¤Æ¤·¤Þ¤Ã¤¿¡£ ¥×¥í¥°¥é¥à¤Ï²ÝÂê¢¤Î¥×¥í¥°¥é¥à¤òRÃÏÅÀ¤Çº¸ÀÞ¤·¡¢TÃÏÅÀ¤Þ¤Ç¥«¥ó¤ò»ý¤Ã¤Æ¤¤¤¯¤è¤¦¤ËÊѤ¨¤¿¤À¤±¤Ê¤Î¤ÇÀâÌÀ¤Ï³ä°¦¤¹¤ë¡£ &br;&br;·ë²Ì¤Ï¥«¥ó¤òÆó¤ÄGOAL¤Þ¤Ç±¿¤ó¤À¤Î¤Ç¡¢´ðËÜÅÀ¤ò6ÅÀ³ÍÆÀ¤·¤¿¡£ *È¿¾Ê¡¦´¶ÁÛ [#d56d594c] ·ë²ÌŪ¤Ë¤Ï´Ö¤Ë¹ç¤ï¤»¤ë¤³¤È¤¬¤Ç¤¤Ê¤«¤Ã¤¿¤¬¡¢¥«¥ó¤òÀѤൡ¹½¤äbluetooth¤Ç¤ÎÄÌ¿®¤Ê¤É¤Î½ê¤ò´°À®¤µ¤»¤ë¤³¤È¤¬¤Ç¤¤¿¤¿¤á¡¢²ù¤¤¤Ï»Ä¤ë¤¬Â礤ÊÉÔËþ¤Ï¤Ê¤¤¡£ &br;»þ´Ö¤¬¹ç¤ï¤º¡¢£´¿Í¤Ç½¸¤Þ¤Ã¤Æºî¶È¤¹¤ë¤³¤È¤¬¤Ç¤¤Ê¤«¤Ã¤¿¤³¤È¤ä¥á¥ó¥Ð¡¼´Ö¤Ç¤ÎÏ¢·È¤¬¾å¼ê¤¯¹Ô¤±¤Æ¤¤¤Ê¤«¤Ã¤¿¤³¤È¤¬Â礤¤¤È»×¤¦¡£ &br;ºÇ¸å¤ÇÀèÀ¸¤¬¸À¤Ã¤Æ¤¤¤¿¤è¤¦¤ËÉÔÈ÷¤Î¤Ê¤¤¥í¥Ü¥Ã¥È¤òºî¤ë¤³¤È¤ÏÆñ¤·¤¯¡¢¤É¤³¤«¤·¤éÉÔ¶ñ¹ç¤¬½Ð¤Æ¤¤Æ¤·¤Þ¤Ã¤¿¡£´Êñ¤Ê¤â¤Î¤Ç¤â³Î¼Â¤ËÆ°ºî¤µ¤»¤ë¤Î¤ÏÆñ¤·¤¤¤³¤È¤À¤È´¶¤¸¤¿¡£ &br;º£¸å¤Ï¥í¥Ü¥Ã¥È¤òÀ©ºî¤¹¤ë¤³¤È¤Ï¤ª¤½¤é¤¯¤Ê¤¤¤À¤í¤¦¤¬¡¢º£²ó¤Î¤è¤¦¤Ë¤¢¤ë²ÝÂê¤ò¤³¤Ê¤¹¥×¥í¥°¥é¥à¤Ê¤ê¤òºî¤ëµ¡²ñ¤Ï¿¤¯¤¢¤ë¤È»×¤¦¤Î¤Ç¡¢¤³¤Î¥¼¥ß¤ÇÇݤ俤³¤È¤ä´¶¤¸¤¿¤³¤È¤òÀ¸¤«¤·¤Æ¤¤¤¤¿¤¤¤È»×¤¦¡£