標(biāo)題: C51單片機(jī)用三個(gè)QTI傳感器循跡寶貝車(chē)源程序 [打印本頁(yè)]
作者: 啥也不懂    時(shí)間: 2017-9-1 15:33
標(biāo)題: C51單片機(jī)用三個(gè)QTI傳感器循跡寶貝車(chē)源程序
用三個(gè)傳感器循跡，寶貝車(chē)
三個(gè)QTI信號(hào)線從右到左一次接P2_1,P2_2,P2_3  


單片機(jī)源程序如下:
  1. /************************************************
  2. 文件 : three QTI Folloe line.c
  3. 描述 ：QTI尋跡傳感器測(cè)試程序
  4. 編寫(xiě) : 任曉東
  5. 說(shuō)明 ：程序利用三個(gè)QTI傳感器實(shí)現(xiàn)了尋線的功能
  6. ************************************************/
  7. #include <AT89X52.h>
  8. #include <stdio.h>
  9. #include<BoeBot.h>

  11. #define uint unsigned int
  12. #define uchar unsigned char
  13. uchar QTIState ;
  14. void Time1_init(void)
  15. {
  16.                
  17.         EA = 1;
  18.         //硬件串口使用定時(shí)器1,供AT89S52與PC機(jī)通信使用
  19.         TMOD |= 0x20;       //定時(shí)器1方式2.8位自動(dòng)重裝模式
  20.         SCON = 0x50;        //模式1，8位數(shù)據(jù)
  21.         TH1 = 0xFD;         //波特率為9600
  22.         TL1 = 0xFD;
  23.         TR1 = 1;            //起動(dòng)定時(shí)器
  24.         TI = 1;
  25. }

  27. void Forward(void)//向前行走子程序
  28. {
  29.         P1_1=1;
  30.         delay_nus(1700);
  31.         P1_1=0;
  32.         P1_0=1;
  33.         delay_nus(1300);
  34.         P1_0=0;
  35.         delay_nms(20);
  36. }

  38. void Pivot_Left(void)//左轉(zhuǎn)子程序
  39. {
  40.           P1_1=1;
  41.           delay_nus(1500);
  42.           P1_1=0;
  43.           P1_0=1;
  44.           delay_nus(1350);
  45.         P1_0=0;
  46.           delay_nms(20);
  47. }

  49. void Pivot_Right(void)//右轉(zhuǎn)子程序
  50. {
  51.           P1_1=1;
  52.           delay_nus(1650);
  53.           P1_1=0;
  54.           P1_0=1;
  55.           delay_nus(1500);
  56.           P1_0=0;
  57.           delay_nms(20);
  58. }

  60. void  Rotate_right(void)
  61. {
  62.         P1_1=1;
  63.           delay_nus(1650);
  64.           P1_1=0;
  65.           P1_0=1;
  66.           delay_nus(1650);
  67.           P1_0=0;
  68.           delay_nms(20);


  71. }

  73. void Rotate_Left(void)
  74. {
  75.         P1_1=1;
  76.           delay_nus(1350);
  77.           P1_1=0;
  78.           P1_0=1;
  79.     delay_nus(1350);
  80.           P1_0=0;
  81.           delay_nms(20);


  84. }
  85. void Get_QTI_State(void)
  86. {
  87.         QTIState = P2&0x0e ;
  88. }

  90. void Follow_Line(void)
  91. {
  92.         Get_QTI_State();
  93.         switch(QTIState)
  94.         {
  95.                 case 0x04 : Forward();
  96.                                         break;
  97.                 case 0x06 : Pivot_Right();
  98.                                         break;
  99.             case 0x02 : Rotate_right();
  100.                                     break;
  101.                 case 0x0c : Pivot_Left();
  102.                                         break;
  103.                 case 0x08 : Rotate_Left();
  104.                                         break;
  105.                 default :  break;
  106. ……………………

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

所有資料51hei提供下載:
three QTI Follow Line.zip (24.91 KB, 下載次數(shù): 23)







歡迎光臨 (http://www.torrancerestoration.com/bbs/) Powered by Discuz! X3.1