找回密碼
 立即注冊(cè)

QQ登錄

只需一步，快速開(kāi)始

搜索
查看: 5007|回復(fù): 1
打印 上一主題 下一主題
收起左側(cè)

搬運(yùn)色塊 巡游景點(diǎn) 巡線機(jī)器人小車的設(shè)計(jì)資料下載

[復(fù)制鏈接]
跳轉(zhuǎn)到指定樓層
樓主
如題！�。。。。。。。。。。。�


包含以下資料：
示例程序\
2017春《計(jì)算機(jī)編程能力實(shí)訓(xùn)》安排.doc
QTI巡線傳感器說(shuō)明及尋線策略.docx
《計(jì)算機(jī)編程能力實(shí)訓(xùn)》動(dòng)員-基于教育機(jī)器人.ppt
任務(wù)書(shū)1_智能搬運(yùn)機(jī)器人的設(shè)計(jì)與實(shí)現(xiàn)_17春.doc
任務(wù)書(shū)2-巡游機(jī)器人設(shè)計(jì)與實(shí)現(xiàn)_17春.doc

程序包含：
threeQTI-3個(gè)QTI傳感器的巡線程序.c
巡游-一個(gè)景點(diǎn)-基于數(shù)組實(shí)現(xiàn).c
巡游-一個(gè)景點(diǎn)-非數(shù)組實(shí)現(xiàn).c
搬運(yùn)-E點(diǎn)黑色.c

部分單片機(jī)源程序預(yù)覽如下:
  1. /************************************************
  2. 程序功能：搬運(yùn)1個(gè)色塊: E點(diǎn)，黑色
  3. 舵機(jī)連接：左輪 P1_1
  4.           右輪 P1_0
  5. QTI傳感器連接：從左至右 P2_4 P2_3 P2_2 P2_1

  7. 程序編寫(xiě)調(diào)試：王淑鴻 2016-6
  8. ************************************************/

  10. #include <Boebot.h>
  11. #include <uart.h>
  12. #define uint unsigned int
  13. #define uchar unsigned char

  15. void fastforward(void);            //快速前進(jìn)1步
  16. void slowforward(void);            //慢速前進(jìn)1步
  17. void slowerback(void);                  // 慢速后退1步
  18. void turn_left(uint n);             //左轉(zhuǎn)
  19. void turn_right(uint n);            //右轉(zhuǎn)
  20. void zhixing(int n);                                //向前直行
  21. void daotui(int i);                        //后退
  22. void check_left(void);              //小幅向左  
  23. void check_right(void);             //小幅向右
  24. void Get_QTI_State(void);            //獲取傳感器返回值
  25. void Follow_Line(void);                //巡線
  26. void Get_E(void) ;                   //取E點(diǎn)物塊，取到中心線上
  27. void Put_Black(void);                         // 將中心線上的黑色色塊推到目標(biāo)位置
  28. void BackToZero(void);                                 //從中心線回到起始區(qū)域


  31. uchar QTIState;

  33. uint RIGHT90=20;
  34. uint RIGHT45=10;
  35. uint RIGHT180=35;

  37. uint LEFT90=25;
  38. uint LEFT45=13;




  43. void fastforward(void)                //快速前進(jìn)
  44. {
  45.         P1_0=1;
  46.         delay_nus(1350);
  47.         P1_0=0;
  48.         delay_nms(20);
  49.         P1_1=1;
  50.         delay_nus(1650);      
  51.         P1_1=0;
  52.         delay_nms(20);
  53. }

  55. void slowforward(void)          //慢速前進(jìn)
  56. {        P1_0=1;
  57.         delay_nus(1450);        
  58.         P1_0=0;
  59.         delay_nms(20);
  60.         P1_1=1;
  61.         delay_nus(1550);
  62.         P1_1=0;
  63.         delay_nms(20);
  64. }

  66. void slowerback(void)                // 慢速后退
  67. {
  68.         P1_0=1;
  69.         delay_nus(1550);        
  70.         P1_0=0;
  71.         delay_nms(20);
  72.         P1_1=1;
  73.         delay_nus(1450);
  74.         P1_1=0;
  75.         delay_nms(20);
  76. }

  78. void turn_left(uint n)              //左轉(zhuǎn)
  79. {
  80.          int i;
  81.      for(i=0;i<=n;i++)
  82.        {
  83.                 P1_0=1;
  84.                 delay_nus(1450);
  85.                 P1_0=0;
  86.                 delay_nms(20);
  87.                 P1_1=1;
  88.                 delay_nus(1450);
  89.                 P1_1=0;
  90.                 delay_nms(20);
  91.            }
  92. }

  94. void turn_right(uint n)            //右轉(zhuǎn)  
  95. {
  96.          int i;
  97.      for(i=0;i<=n;i++)
  98.        {
  99.                 P1_0=1;
  100.                 delay_nus(1550);
  101.                 P1_0=0;
  102.                 delay_nms(20);
  103.                 P1_1=1;
  104.                 delay_nus(1550);
  105.                 P1_1=0;
  106.                 delay_nms(20);
  107.            }
  108. }





  114. void zhixing(int n)                          //直行
  115. {
  116.         int a;
  117.         for(a=0;a<=n;a++)
  118.         fastforward();
  119. }


  122. void daotui(int n)                        //慢速倒退
  123. {
  124.         int a;
  125.         for(a=0;a<=n;a++)
  126.         slowerback();
  127. }

  129. void check_left(void)     //小幅向左
  130. {       
  131.             P1_0=1;
  132.             delay_nus(1400);         
  133.                  P1_0=0;
  134.             delay_nms(20);
  135.                 P1_1=1;
  136.                 delay_nus(1500);
  137.                 P1_1=0;
  138.                 delay_nms(20);
  139. }

  141. void check_right(void)    //小幅向右
  142. {
  143.           P1_1=1;
  144.           delay_nus(1600);         
  145.           P1_1=0;
  146.           delay_nms(20);
  147.           P1_0=1;
  148.           delay_nus(1500);
  149.           P1_0=0;
  150.           delay_nms(20);  
  151. }



  155. void Get_QTI_State(void)                       //獲取傳感器返回值
  156.         {
  157.                 QTIState=P2&0x1e;                     //P2_4  P2_3  P2_2  P2_1
  158.                 QTIState=QTIState/2;                  //右移1位               
  159.         }



  163. void Follow_Line(void)                //巡線
  164. {
  165.                                                    

  167.                 Get_QTI_State();

  169.         switch(QTIState)                         
  170.                 {
  171.                 case 4: check_left() ;break;                        //傳感器返回值：0100
  172.                 case 2: check_right();break;                        //傳感器返回值：0010
  173.                 case 8: check_left() ;break;                        //傳感器返回值：1000
  174.                 case 12: check_left() ;break;                        //傳感器返回值：1100
  175.                 case 14: check_left() ;break;                        //傳感器返回值：1110
  176.                 case 1: check_right();break;                        //傳感器返回值：0001
  177.                 case 3: check_right();break;                        //傳感器返回值：0011
  178.                 case 7: check_right();break;                        //傳感器返回值：0111
  179.                 default: slowforward();break;
  180.                 }
  181. }


  184. void Get_E(void)                          //取E點(diǎn)物塊，取到中心線上
  185. {
  186.         int i;
  187.         while(QTIState!=0x0f)                 //當(dāng)不是全黑時(shí)，巡線
  188.         Follow_Line();
  189.         zhixing(6);                                                          //直行一小段，調(diào)整位置
  190.         turn_right(RIGHT90);                  //右轉(zhuǎn)90度
  191.         while(QTIState!=0x00)                 //當(dāng)不是全白時(shí)，巡線
  192.         Follow_Line();
  193.         zhixing(6);
  194.     turn_right(RIGHT180);
  195.         while(QTIState!=0x0f)                 //當(dāng)不是全黑時(shí)，巡線
  196.         Follow_Line();
  197.         zhixing(6);
  198.         turn_left(LEFT90);                                          //左轉(zhuǎn)90度
  199.         for(i=0;i<40;i++)
  200.                 Follow_Line();
  201.     turn_right(RIGHT180);                  
  202. }

  204. void Put_Black(void)                                 // 將中心線上的黑色色塊推到目標(biāo)位置
  205. {
  206.         int i;        
  207.         while(QTIState!=0x0f)                 //當(dāng)不是全黑時(shí)，巡線
  208.         Follow_Line();
  209.         zhixing(6);
  210.         turn_right(RIGHT45);
  211.         while(QTIState!=0x00)                 //當(dāng)不是全白時(shí)，巡線
  212.         Follow_Line();
  213.         zhixing(6);
  214.         while(QTIState!=0x0f)                 //當(dāng)不是全黑時(shí)，巡線
  215.         Follow_Line();
  216.         daotui(20);
  217.         turn_right(RIGHT180);  
  218.         while(QTIState!=0x00)                 //當(dāng)不是全白時(shí)，巡線
  219.         Follow_Line();
  220.         zhixing(6);
  221.         while(QTIState!=0x0f)                 //當(dāng)不是全黑時(shí)，巡線
  222.     Follow_Line();
  223.         zhixing(6);
  224.         turn_left(LEFT45);
  225. ……………………

  227. …………限于本文篇幅 余下代碼請(qǐng)從51黑下載附件…………
復(fù)制代碼

所有資料51hei提供下載:
課程設(shè)計(jì)-自通-機(jī)器人-17春.rar (1.59 MB, 下載次數(shù): 32)


分享到:  QQ好友和群QQ好友和群 QQ空間QQ空間 騰訊微博騰訊微博 騰訊朋友騰訊朋友
收藏收藏1 分享淘帖 頂頂 踩踩

相關(guān)帖子
回復(fù)

使用道具 舉報(bào)

沙發(fā)
ID:1 發(fā)表于 2017-6-25 02:39 | 只看該作者
好資料，51黑有你更精彩!!!
回復(fù)

使用道具 舉報(bào)

本版積分規(guī)則

手機(jī)版|小黑屋|51黑電子論壇 |51黑電子論壇6群 QQ 管理員QQ:125739409;技術(shù)交流QQ群281945664

Powered by 單片機(jī)教程網(wǎng)

快速回復(fù) 返回頂部 返回列表