欧美极品高清xxxxhd,国产日产欧美最新,无码AV国产东京热AV无码,国产精品人与动性XXX,国产传媒亚洲综合一区二区,四库影院永久国产精品,毛片免费免费高清视频,福利所导航夜趣136

標題: C51單片機用三個QTI傳感器循跡寶貝車源程序 [打印本頁]
作者: 啥也不懂    時間: 2017-9-1 15:33
標題: C51單片機用三個QTI傳感器循跡寶貝車源程序
用三個傳感器循跡，寶貝車
三個QTI信號線從右到左一次接P2_1,P2_2,P2_3  


單片機源程序如下:
  1. /************************************************
  2. 文件 : three QTI Folloe line.c
  3. 描述 ：QTI尋跡傳感器測試程序
  4. 編寫 : 任曉東
  5. 說明 ：程序利用三個QTI傳感器實現了尋線的功能
  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.         //硬件串口使用定時器1,供AT89S52與PC機通信使用
  19.         TMOD |= 0x20;       //定時器1方式2.8位自動重裝模式
  20.         SCON = 0x50;        //模式1，8位數據
  21.         TH1 = 0xFD;         //波特率為9600
  22.         TL1 = 0xFD;
  23.         TR1 = 1;            //起動定時器
  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)//左轉子程序
  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)//右轉子程序
  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. …………限于本文篇幅 余下代碼請從51黑下載附件…………
復制代碼

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







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