找回密码
 立即注册

QQ登录

只需一步,快速开始

搜索
查看: 4689|回复: 3
打印 上一主题 下一主题
收起左侧

TCRT5000+STM32红外循迹小车程序

[复制链接]
跳转到指定楼层
楼主
ID:511050 发表于 2019-4-22 11:19 | 只看该作者 回帖奖励 |倒序浏览 |阅读模式
用正点原子的精英版作为主控,红外循迹用TCRT5000芯片。

单片机源程序如下:
  1. /* Includes ------------------------------------------------------------------*/
  2. #include "stm32f10x.h"
  3. #include "stm32f10x_tim.h"
  4. #include "stm32f10x_flash.h"
  5. #include "stm32f10x_exti.h"
  6. #include "stm32f10x_rcc.h"
  7. #include "systick.h"
  8. #include "stdio.h"
  9. #include "misc.h"

  10. #define infra1 GPIO_ReadInputDataBit(GPIOC, GPIO_Pin_7);
  11. #define infra2 GPIO_ReadInputDataBit(GPIOC, GPIO_Pin_8);

  12. #define tube1 GPIO_ReadInputDataBit(GPIOC, GPIO_Pin_0);
  13. #define tube2 GPIO_ReadInputDataBit(GPIOC, GPIO_Pin_1);
  14. #define tube3 GPIO_ReadInputDataBit(GPIOC, GPIO_Pin_2);
  15. #define tube4 GPIO_ReadInputDataBit(GPIOC, GPIO_Pin_3);
  16.                

  17. TIM_OCInitTypeDef  TIM1_OCInitStructure;

  18. extern FlagStatus  Status;

  19. extern u16 TIM1Compare1[3] = {0,0x3FFF,0x1FFF};
  20. extern u16 TIM1Compare2[3] = {0x7FFF,0x3FFF,0x1FFF};
  21. extern u16 TIM1Compare3[3] = {0,0x3FFF,0x1FFF};
  22. extern u16 TIM1Compare4[3] = {0x7FFF,0x3FFF,0x1FFF};
  23. extern u16 tubecnt;
  24. extern u16 flag;
  25. extern int add;

  26. void GPIO_Configuration(void);
  27. void TIM_Configuration(void);
  28. void tim2_Configuration(void);
  29. void exti_Configuration(void);
  30. void nvic_Configuration(void);

  31. void zhi1(void);
  32. void zhi2(void);
  33. void zhi3(void);
  34. void zuoxiao(void);
  35. void zuoda(void);
  36. void youxiao(void);
  37. void youda(void);
  38. void xunji(void);
  39. u16 ceju(void);


  40. int main(void)
  41. {
  42.        
  43.         RCC_Configuration();
  44.         GPIO_Configuration();
  45.         TIM_Configuration();
  46.         delay_init();

  47.         while(1)
  48.         {
  49.          GPIO_ResetBits(GPIOE,GPIO_Pin_15);
  50.          GPIO_ResetBits(GPIOB,GPIO_Pin_11);
  51.         }
  52.                
  53. }
  54. void GPIO_Configuration(void)
  55. {
  56.   GPIO_InitTypeDef GPIO_InitStructure;

  57. /*TIM1  PWM  输出:A9:CH1/A10:CH2                */
  58.   GPIO_InitStructure.GPIO_Pin = GPIO_Pin_10|GPIO_Pin_9;
  59.   GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF_PP;
  60.   GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
  61.   GPIO_Init(GPIOA, &GPIO_InitStructure);

  62. /*LED显示:LED5:PE15 / LED6:PB11 / LED7:PE14 / LED8:PB10         */

  63.   GPIO_InitStructure.GPIO_Pin = GPIO_Pin_10|GPIO_Pin_11;
  64.   GPIO_InitStructure.GPIO_Mode =GPIO_Mode_Out_PP;
  65.   GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
  66.   GPIO_Init(GPIOB, &GPIO_InitStructure);
  67.                  GPIO_SetBits(GPIOB,GPIO_Pin_10);
  68.                 GPIO_SetBits(GPIOB,GPIO_Pin_11);
  69.   GPIO_InitStructure.GPIO_Pin = GPIO_Pin_14|GPIO_Pin_15;
  70.   GPIO_InitStructure.GPIO_Mode =GPIO_Mode_Out_PP;
  71.   GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
  72.   GPIO_Init(GPIOE, &GPIO_InitStructure);
  73.                   GPIO_SetBits(GPIOE,GPIO_Pin_14);
  74.                 GPIO_SetBits(GPIOE,GPIO_Pin_15);
  75.   
  76. /*红外管:infra1-> PC7, infra2-> PC8         浮空输入  */

  77.   GPIO_InitStructure.GPIO_Pin = GPIO_Pin_7 | GPIO_Pin_8 ;
  78.   GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IN_FLOATING;
  79.   GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
  80.   GPIO_Init(GPIOC, &GPIO_InitStructure);   

  81. /*光电管:tube1-> PC0, tube2-> PC1, tube3-> PC2, tube4-> PC3        浮空输入*/
  82.   GPIO_InitStructure.GPIO_Pin = GPIO_Pin_0 | GPIO_Pin_1|GPIO_Pin_2 | GPIO_Pin_3;
  83.   GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IN_FLOATING;
  84.   GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
  85.   GPIO_Init(GPIOC, &GPIO_InitStructure);

  86. /*超声波:Trig:PB9                Echo:PB8   */
  87.         GPIO_InitStructure.GPIO_Pin = GPIO_Pin_9;
  88.         GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP;
  89.         GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;                          
  90.         GPIO_Init(GPIOB, &GPIO_InitStructure);
  91.         GPIO_ResetBits( GPIOB, GPIO_Pin_9);
  92.    
  93.         GPIO_InitStructure.GPIO_Pin = GPIO_Pin_8;
  94.         GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IN_FLOATING;            //PB1接受采集上升沿 PB6低电平
  95.         GPIO_Init(GPIOB, &GPIO_InitStructure);
  96.         GPIO_ResetBits(GPIOB,GPIO_Pin_8);
  97. }

  98. void TIM_Configuration(void)
  99. {
  100.         TIM_TimeBaseInitTypeDef  TIM1_TimeBaseStructure;
  101.         TIM_OCInitTypeDef  TIM1_OCInitStructure;
  102.        

  103.           TIM_DeInit(TIM1);

  104.          /* Time Base configuration */
  105.           TIM1_TimeBaseStructure.TIM_Prescaler = 0x0; //设置了用来作为TIMx时钟频率除数的预分频值
  106.         TIM1_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up;         //选择了计数器模式
  107.         TIM1_TimeBaseStructure.TIM_Period = 0xFFFF;  //设置了在下一个更新事件装入活动的自动重装载寄存器周期  ARR
  108.         TIM1_TimeBaseStructure.TIM_ClockDivision = 0x0;  //设置了时钟分割
  109.         TIM1_TimeBaseStructure.TIM_RepetitionCounter = 0x0;         //设置了周期计数器值

  110.         TIM_TimeBaseInit(TIM1,&TIM1_TimeBaseStructure);//根据TIM_TimeBaseInitStruct中指定的参数初始化TIMx的时间基数单位(5个参数)
  111.                                                                                                         //TIM1基本计数器设置(设置PWM频率) //频率=TIM1_CLK/(ARR+1)

  112.         /* Channel 1, 2,3 and 4 Configuration in PWM mode */
  113.         TIM1_OCInitStructure.TIM_OCMode = TIM_OCMode_PWM2;
  114.         TIM1_OCInitStructure.TIM_OutputState = TIM_OutputState_Enable;
  115.         TIM1_OCInitStructure.TIM_OutputNState = TIM_OutputNState_Enable;                  
  116.         TIM1_OCInitStructure.TIM_Pulse = 0x0;
  117.         TIM1_OCInitStructure.TIM_OCPolarity = TIM_OCPolarity_Low;
  118.         TIM1_OCInitStructure.TIM_OCNPolarity = TIM_OCNPolarity_Low;         
  119.         TIM1_OCInitStructure.TIM_OCIdleState = TIM_OCIdleState_Set;
  120.         TIM1_OCInitStructure.TIM_OCNIdleState = TIM_OCIdleState_Reset;
  121.           
  122.         TIM_OC1Init(TIM1,&TIM1_OCInitStructure);          //同TimeBaseStructure        (8个参数)        //TIM1_OC1模块设置(设置1通道占空比)
  123.        
  124.         TIM1_OCInitStructure.TIM_Pulse = 0x7fff;
  125.         TIM_OC2Init(TIM1,&TIM1_OCInitStructure);         //同TimeBaseStructure
  126.        
  127.         TIM1_OCInitStructure.TIM_Pulse = 0x0;
  128.         TIM_OC3Init(TIM1,&TIM1_OCInitStructure);         //同TimeBaseStructure
  129.        
  130.         TIM1_OCInitStructure.TIM_Pulse = 0x7fff;
  131.         TIM_OC4Init(TIM1,&TIM1_OCInitStructure);         //同TimeBaseStructure       
  132.        
  133.         TIM_Cmd(TIM1,ENABLE);                  //先设置好了TimeBase、OC、BDTR  使能或者失能TIM1外设
  134.        
  135.         /* Main Output Enable */
  136.         TIM_CtrlPWMOutputs(TIM1,DISABLE);        //TIM1_CtrlPWMOutputs(ENABLE); 使能或者失能TIM1的主输出

  137. }

  138. void zhi1(void)                //直走速度1
  139. {
  140.         TIM_SetCompare1(TIM1,TIM1Compare1[0]);
  141.         TIM_SetCompare2(TIM1,TIM1Compare2[0]);
  142.         TIM_SetCompare3(TIM1,TIM1Compare3[0]);
  143.         TIM_SetCompare4(TIM1,TIM1Compare4[0]);
  144.         TIM_CtrlPWMOutputs(TIM1,ENABLE);       
  145. }

  146. void zhi2(void)                //直走速度2(慢)
  147. {
  148.         TIM_SetCompare1(TIM1,TIM1Compare1[0]);
  149.         TIM_SetCompare2(TIM1,TIM1Compare2[1]);
  150.         TIM_SetCompare3(TIM1,TIM1Compare3[0]);
  151.         TIM_SetCompare4(TIM1,TIM1Compare4[1]);
  152.         TIM_CtrlPWMOutputs(TIM1,ENABLE);       
  153. }

  154. void zhi(void)                //直走速度3(很慢)
  155. {
  156.         TIM_SetCompare1(TIM1,TIM1Compare1[0]);
  157.         TIM_SetCompare2(TIM1,TIM1Compare2[2]);
  158.         TIM_SetCompare3(TIM1,TIM1Compare3[0]);
  159.         TIM_SetCompare4(TIM1,TIM1Compare4[2]);
  160.         TIM_CtrlPWMOutputs(TIM1,ENABLE);       
  161. }

  162. void zuoxiao(void)                   //左小转
  163. {
  164.         TIM_SetCompare1(TIM1,TIM1Compare1[0]);
  165.         TIM_SetCompare2(TIM1,TIM1Compare2[1]);
  166.         TIM_SetCompare3(TIM1,TIM1Compare3[0]);
  167.         TIM_SetCompare4(TIM1,TIM1Compare4[0]);
  168.         TIM_CtrlPWMOutputs(TIM1,ENABLE);       
  169. }

  170. void zuoda(void)                   //左大转
  171. {
  172.         TIM_SetCompare1(TIM1,TIM1Compare1[0]);
  173.         TIM_SetCompare2(TIM1,0);
  174.         TIM_SetCompare3(TIM1,TIM1Compare3[0]);
  175.         TIM_SetCompare4(TIM1,TIM1Compare4[0]);
  176.         TIM_CtrlPWMOutputs(TIM1,ENABLE);       
  177. }

  178. void youxiao(void)                   //右小转
  179. {
  180.         TIM_SetCompare1(TIM1,TIM1Compare1[0]);
  181.         TIM_SetCompare2(TIM1,TIM1Compare2[1]);
  182.         TIM_SetCompare3(TIM1,TIM1Compare3[0]);
  183.         TIM_SetCompare4(TIM1,TIM1Compare4[0]);
  184.         TIM_CtrlPWMOutputs(TIM1,ENABLE);       
  185. }

  186. void youda(void)                   //右大转
  187. {
  188.         TIM_SetCompare1(TIM1,TIM1Compare1[0]);
  189.         TIM_SetCompare2(TIM1,0);
  190.         TIM_SetCompare3(TIM1,TIM1Compare3[0]);
  191.         TIM_SetCompare4(TIM1,TIM1Compare4[0]);
  192.         TIM_CtrlPWMOutputs(TIM1,ENABLE);       
  193. }

  194. void xunji(void)                           //循迹
  195. {       
  196.         zhi1();
  197.         if(GPIO_ReadInputDataBit(GPIOC, GPIO_Pin_7)) youxiao();       
  198.         if(GPIO_ReadInputDataBit(GPIOC, GPIO_Pin_8)) zuoxiao();
  199.         if(1)
  200.         {
  201.                 tubecnt++;
  202.                 zhi1();
  203.                 delay_ms(100);
  204.                 zuoda();
  205.                 delay_ms(100);
  206.         }
  207.                        
  208. }

  209. u16 ceju(void)
  210. {
  211.         u16 juli;
  212.         flag=0;
  213.         GPIO_SetBits( GPIOB, GPIO_Pin_9);
  214.         TIM_Cmd(TIM2,ENABLE);
  215.         while(juli==0);
  216.         juli=add*3.4;;
  217.         flag=0;
  218.         return juli;
  219. }

  220. void tim2_Configuration(void)
  221. {
  222.         TIM_TimeBaseInitTypeDef  TIM_TimeBaseStructure;
  223.         RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM2|RCC_APB1Periph_TIM3, ENABLE);

  224.         TIM_DeInit(TIM2);
  225.         TIM_TimeBaseStructure.TIM_Period=72-1;
  226.         TIM_TimeBaseStructure.TIM_Prescaler=15-1;
  227.         TIM_TimeBaseStructure.TIM_ClockDivision = TIM_CKD_DIV1;
  228.         TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up;
  229.         TIM_TimeBaseInit(TIM2, & TIM_TimeBaseStructure);
  230.         TIM_ClearFlag(TIM2,TIM_FLAG_Update);
  231.     TIM_ITConfig(TIM2,TIM_IT_Update,ENABLE);
  232.     TIM_Cmd(TIM2,DISABLE);
  233.        
  234.         TIM_DeInit(TIM3);
  235.         TIM_TimeBaseStructure.TIM_Prescaler =72-1;  //设置了用来作为TIMx时钟频率除数的预分频值
  236.     TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up;         //选择了计数器模式
  237.     TIM_TimeBaseStructure.TIM_Period = 20-1;   //设置了15us在下一个更新事件装入活动的自动重装载寄存器周期  ARR
  238.         TIM_TimeBaseStructure.TIM_ClockDivision = TIM_CKD_DIV1 ; //设置了时钟分割
  239.         TIM_TimeBaseInit(TIM3, & TIM_TimeBaseStructure);
  240.         TIM_ClearFlag(TIM3,TIM_FLAG_Update);
  241.     TIM_ITConfig(TIM3,TIM_IT_Update,ENABLE);
  242.         TIM_Cmd(TIM3,DISABLE);
  243. }

  244. void exti_Configuration(void)
  245. {
  246.         EXTI_InitTypeDef EXTI_InitStructure;

  247.         EXTI_DeInit();
  248.         GPIO_EXTILineConfig(GPIO_PortSourceGPIOB, GPIO_PinSource8);

  249.         EXTI_InitStructure.EXTI_Line = EXTI_Line8;
  250.         EXTI_InitStructure.EXTI_Mode = EXTI_Mode_Interrupt;
  251.         EXTI_InitStructure.EXTI_Trigger =EXTI_Trigger_Rising_Falling;
  252.         EXTI_InitStructure.EXTI_LineCmd = ENABLE;
  253.         EXTI_Init(&EXTI_InitStructure);          
  254. }

  255. void nvic_Configuration(void)
  256. {
  257.         NVIC_InitTypeDef NVIC_InitStructure;

  258.         #ifdef  VECT_TAB_RAM  
  259.           /* Set the Vector Table base location at 0x20000000 */
  260.           NVIC_SetVectorTable(NVIC_VectTab_RAM, 0x0);
  261.         #else  /* VECT_TAB_FLASH  */
  262.           /* Set the Vector Table base location at 0x08000000 */
  263.          
  264.         NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2);
  265.        
  266.         NVIC_InitStructure.NVIC_IRQChannel =TIM2_IRQChannel;
  267.         NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 2;
  268.         NVIC_InitStructure.NVIC_IRQChannelSubPriority = 1;
  269.         NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE;
  270.         NVIC_Init(&NVIC_InitStructure);

  271.         NVIC_InitStructure.NVIC_IRQChannel =TIM3_IRQChannel;
  272.         NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 0;
  273.         NVIC_InitStructure.NVIC_IRQChannelSubPriority = 3;
  274.         NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE;
  275.         NVIC_Init(&NVIC_InitStructure);

  276.         NVIC_InitStructure.NVIC_IRQChannel =EXTI9_5_IRQChannel ;
  277.         NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority =1;
  278.         NVIC_InitStructure.NVIC_IRQChannelSubPriority = 0;
  279.         NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE;
  280.         NVIC_Init(&NVIC_InitStructure);

  281.         #endif
  282. ……………………

  283. …………限于本文篇幅 余下代码请从51黑下载附件…………
复制代码

所有资料51hei提供下载:
STM32_小车_V1.7z (137.63 KB, 下载次数: 107)

分享到:  QQ好友和群QQ好友和群 QQ空间QQ空间 腾讯微博腾讯微博 腾讯朋友腾讯朋友
收藏收藏3 分享淘帖 顶 踩
回复

使用道具 举报

沙发
ID:682261 发表于 2020-1-7 14:45 | 只看该作者
大佬,您用的TCRT5000是几路几伏的啊
回复

使用道具 举报

板凳
ID:505042 发表于 2020-7-5 22:24 | 只看该作者
报错  四个未定义
回复

使用道具 举报

地板
ID:582255 发表于 2020-10-14 22:26 | 只看该作者
请问你的跑道是多宽的
回复

使用道具 举报

您需要登录后才可以回帖 登录 | 立即注册

本版积分规则

手机版|小黑屋|51黑电子论坛 |51黑电子论坛6群 QQ 管理员QQ:125739409;技术交流QQ群281945664

Powered by 单片机教程网

快速回复 返回顶部 返回列表