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

標題: STM32F103智能紅外循跡小車，包括完整碼盤測速，蔽障，等功能完美實現，庫函數編寫 [打印本頁]
作者: phwtx2007    時間: 2018-4-6 22:09
標題: STM32F103智能紅外循跡小車，包括完整碼盤測速，蔽障，等功能完美實現，庫函數編寫
智能小車 尋跡、測速

單片機源程序如下:
  1. #include "stm32f10x.h"
  2. #include "CommonTypeDefine.h"
  3. #include "Wheel.h"
  4. #include <stdio.h>
  5. #include "LCD.h"


  8. int DELAY1[2]={5,60};
  9. static WheelVeer AaFLeftWheelVeer=positiveDirection;
  10. static WheelVeer AaFRightWheelVeer=positiveDirection;
  11. static char DirectionOfMotion=0; //運動方向 0正走 1反走
  12. static char AvoidanceStatus=0;  //0表示沒有在避障1、2、3、4、5、6、7分別代表避障的7個階段
  13. static char BarrierDirection=0;        //0表示沒有在避障1、2分別代表在左邊和右邊
  14. int AaFWheelVeerArray1[8]={2,0,-2,0,-2,0,2,0};
  15. int AaFWheelVeerArray2[8]={-2,0,2,0,2,0,-2,0};

  17. static char CarStatus=1;
  18. static int timeCounter=0;
  19. static int LCDtimeCounter=100;
  20. void AaFDelay(int);
  21. void doSometingelse(void);
  22. void show(void);
  23. void showLeft(void);
  24. void showRight(void);
  25. void CarControlInit()
  26. {
  27.     GPIO_InitTypeDef GPIO_InitStructure;
  28.     RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA|RCC_APB2Periph_GPIOB, ENABLE);

  30.         //LCD相關配置
  31.         RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOB, ENABLE);
  32.           RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA|RCC_APB2Periph_SPI1, ENABLE);
  33.           LCD_Init();
  34.           LCD_Clr();
  35.     //蔽障中斷口線
  36.     GPIO_InitStructure.GPIO_Pin=GPIO_Pin_4|GPIO_Pin_3;
  37.     GPIO_InitStructure.GPIO_Mode=GPIO_Mode_IPU;
  38.     GPIO_Init(GPIOA,&GPIO_InitStructure);       
  39.   
  40.     //小車尋跡口線配置
  41.     GPIO_InitStructure.GPIO_Pin=GPIO_Pin_2|GPIO_Pin_7|GPIO_Pin_13|GPIO_Pin_14|GPIO_Pin_15;
  42.     GPIO_InitStructure.GPIO_Mode=GPIO_Mode_IPU;
  43.     GPIO_Init(GPIOB,&GPIO_InitStructure);
  44.     GPIO_InitStructure.GPIO_Pin=GPIO_Pin_1;
  45.     GPIO_InitStructure.GPIO_Mode=GPIO_Mode_IPU;
  46.     GPIO_Init(GPIOA,&GPIO_InitStructure);
  47.     NVIC_SetVectorTable(NVIC_VectTab_FLASH, 0x00000);
  48.     if (SysTick_Config(SystemCoreClock /100))
  49.     {
  50.        while (1);
  51.     }
  52.     NVIC_SetPriority(SysTick_IRQn, 0x0);
  53.     WheelInit(positiveDirection,(char)255);
  54. }
  55. void AvoidanceAndFollow()
  56. {
  57.         if(AvoidanceStatus==0)
  58.         {
  59.           if(DirectionOfMotion==0)
  60.           {
  61.             if(GPIO_ReadInputDataBit(GPIOA,GPIO_Pin_4)==RESET)  //左邊有障礙物
  62.             {
  63.                 AvoidanceStatus=8;
  64.                 BarrierDirection=1;
  65.             }
  66.             else if(GPIO_ReadInputDataBit(GPIOA,GPIO_Pin_3)==RESET)  //右邊有障礙物
  67.             {
  68.                 AvoidanceStatus=8;
  69.                 BarrierDirection=2;
  70.             }
  71.             else if((GPIO_ReadInputDataBit(GPIOB,GPIO_Pin_2)==RESET)&&(GPIO_ReadInputDataBit(GPIOB,GPIO_Pin_13)==RESET)&&(GPIO_ReadInputDataBit(GPIOA,GPIO_Pin_1)==RESET))
  72.             {
  73.                 CarStatus=0;
  74.                 AaFLeftWheelVeer=stop;
  75.                 AaFRightWheelVeer=stop;       
  76.             }
  77.             else if(GPIO_ReadInputDataBit(GPIOB,GPIO_Pin_2)==RESET)  //黑線壓在右邊
  78.             {
  79.                 AaFLeftWheelVeer=positiveDirection;
  80.                 AaFRightWheelVeer=stop;       
  81.             }
  82.             else if(GPIO_ReadInputDataBit(GPIOA,GPIO_Pin_1)==RESET)  //黑線壓在左邊
  83.             {
  84.                 AaFLeftWheelVeer=stop;
  85.                 AaFRightWheelVeer=positiveDirection;       
  86.             }
  87.             else if(GPIO_ReadInputDataBit(GPIOB,GPIO_Pin_13)==RESET)  //黑線壓在中間
  88.             {
  89.                 AaFLeftWheelVeer=positiveDirection;
  90.                 AaFRightWheelVeer=positiveDirection;       
  91.             }
  92.           }
  93.           else if(DirectionOfMotion==1)
  94.           {
  95.                   if((GPIO_ReadInputDataBit(GPIOB,GPIO_Pin_7)==RESET)&&(GPIO_ReadInputDataBit(GPIOB,GPIO_Pin_14)==RESET)&&(GPIO_ReadInputDataBit(GPIOB,GPIO_Pin_15)==RESET))
  96.             {
  97.                 CarStatus=0;
  98.                 AaFLeftWheelVeer=stop;
  99.                 AaFRightWheelVeer=stop;       
  100.             }
  101.             else if(GPIO_ReadInputDataBit(GPIOB,GPIO_Pin_15)==RESET)  //黑線壓在右邊
  102.             {
  103.                 AaFLeftWheelVeer=reverseDirection;
  104.                 AaFRightWheelVeer=stop;       
  105.             }
  106.             else if(GPIO_ReadInputDataBit(GPIOB,GPIO_Pin_7)==RESET)  //黑線壓在左邊
  107.             {
  108.                 AaFLeftWheelVeer=stop;
  109.                 AaFRightWheelVeer=reverseDirection;       
  110.             }
  111.             else if(GPIO_ReadInputDataBit(GPIOB,GPIO_Pin_14)==RESET)  //黑線壓在中間
  112.             {
  113.                 AaFLeftWheelVeer=reverseDirection;
  114.                 AaFRightWheelVeer=reverseDirection;       
  115.             }
  116.           }
  117.         }
  118.     timeCounter--;
  119. }
  120. void CarControl()
  121. {
  122.     while(1)
  123.     {
  124.                 while(CarStatus==1)
  125.                 {
  126.                    if(AvoidanceStatus>0)
  127.                    {
  128.                                 if(BarrierDirection==1)
  129.                                 {
  130.                                           TurnCar(AaFWheelVeerArray1[8-AvoidanceStatus]);
  131.                                 }
  132.                                 else if(BarrierDirection==2)
  133.                                 {
  134.                                         TurnCar(AaFWheelVeerArray2[8-AvoidanceStatus]);
  135.                                 }
  136.                                 if(AvoidanceStatus==5)
  137.                                 {
  138.                                         AaFDelay(120);
  139.                                 }
  140.                                 else
  141.                                 {
  142.                                         AaFDelay(DELAY1[AvoidanceStatus%2]);
  143.                                 }
  144.                                 AvoidanceStatus--;
  145.                                 AaFDelay(2);
  146.                    }
  147.                    else
  148.                    {
  149.                         WheelSetVeer(leftWheel,AaFLeftWheelVeer);
  150.                         WheelSetVeer(rightWheel,AaFRightWheelVeer);
  151.                         AaFDelay(1);
  152.                    }
  153.                    show();
  154.                 }
  155.                 WheelSetVeer(leftWheel,AaFLeftWheelVeer);
  156.                 WheelSetVeer(rightWheel,AaFRightWheelVeer);
  157.                 show();
  158.                 doSometingelse();

  160.     }
  161. }
  162. void AaFDelay(int t)
  163. {
  164.    timeCounter=t;
  165.    while(timeCounter);
  166. }
  167. void doSometingelse()
  168. {
  169.         AaFDelay(100);
  170.         if(DirectionOfMotion==0)
  171.         {
  172.            DirectionOfMotion=1;
  173.         }
  174.         else if(DirectionOfMotion==1)
  175.         {
  176.            DirectionOfMotion=0;
  177.         }
  178.         //Other
  179.         //TurnCar(left);
  180.         //TurnCar(left);
  181.         CarStatus=1;
  182. }
  183. void show()
  184. {
  185.         if(LCDtimeCounter==0)
  186.         {
  187.                 LCDtimeCounter=100;
  188.                 showLeft();
  189.                 showRight();
  190. ……………………

  192. …………限于本文篇幅 余下代碼請從51黑下載附件…………
復制代碼

所有資料51hei提供下載:
智能紅外循跡小車，包括完整碼盤測速，蔽障，等功能完美實現，庫函數編寫，便于閱讀.rar (293.78 KB, 下載次數: 183)


作者: lq1425988716    時間: 2018-7-18 10:16
為什么有錯啊
作者: jiangkeqin_sy    時間: 2018-10-22 16:39
在下載不了啊
作者: jiangkeqin_sy    時間: 2018-10-24 09:42
復制，學習，別人的經驗



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