找回密码
 立即注册

QQ登录

只需一步,快速开始

搜索
查看: 4048|回复: 0
收起左侧

STM32红外寻循迹小车源码

[复制链接]
ID:305426 发表于 2018-11-30 16:58 | 显示全部楼层 |阅读模式
循迹小车源码分享给大家。

单片机源程序如下:
  1. //连接方式 :请参考interface.h文件
  2. #include "stm32f10x.h"
  3. #include "interface.h"
  4. #include "LCD1602.h"
  5. #include "IRCtrol.h"
  6. #include "motor.h"
  7. #include "uart.h"

  8. //全局变量定义
  9. unsigned int speed_count=0;//占空比计数器 50次一周期
  10. char front_left_speed_duty=SPEED_DUTY;
  11. char front_right_speed_duty=SPEED_DUTY;
  12. char behind_left_speed_duty=SPEED_DUTY;
  13. char behind_right_speed_duty=SPEED_DUTY;

  14. unsigned char tick_5ms = 0;//5ms计数器,作为主函数的基本周期
  15. unsigned char tick_1ms = 0;//1ms计数器,作为电机的基本计数器
  16. unsigned char tick_200ms = 0;//刷新显示

  17. char ctrl_comm = COMM_STOP;//控制指令
  18. char ctrl_comm_last = COMM_STOP;//上一次的指令
  19. unsigned char continue_time=0;
  20. unsigned char bt_rec_flag=0;//蓝牙控制标志位

  21. //循迹,通过判断三个光电对管的状态来控制小车运动
  22. void SearchRun(void)
  23. {
  24.         //三路都检测到
  25.         if(SEARCH_M_IO == BLACK_AREA && SEARCH_L_IO == BLACK_AREA && SEARCH_R_IO == BLACK_AREA)
  26.         {
  27.                 ctrl_comm = COMM_UP;
  28.                 return;
  29.         }
  30.        
  31.         if(SEARCH_R_IO == BLACK_AREA)//右
  32.         {
  33.                 ctrl_comm = COMM_RIGHT;
  34.         }
  35.         else if(SEARCH_L_IO == BLACK_AREA)//左
  36.         {
  37.                 ctrl_comm = COMM_LEFT;
  38.         }
  39.         else if(SEARCH_M_IO == BLACK_AREA)//中
  40.         {
  41.                 ctrl_comm = COMM_UP;
  42.         }
  43. }


  44. int main(void)
  45. {
  46.         delay_init();
  47.         GPIOCLKInit();
  48.         UserLEDInit();
  49.         LCD1602Init();
  50.         //IRCtrolInit();
  51.         TIM2_Init();
  52.         MotorInit();
  53.         ServoInit();
  54.        
  55.         RedRayInit();
  56.         //USART3Conf(9600);

  57. while(1)
  58. {         
  59.                          if(tick_5ms >= 5)
  60.                 {
  61.                         tick_5ms = 0;
  62.                         tick_200ms++;
  63.                         if(tick_200ms >= 40)
  64.                         {
  65.                                 tick_200ms = 0;
  66.                                 LEDToggle(LED_PIN);
  67.                         }
  68. //                        continue_time--;//200ms 无接收指令就停车
  69. //                        if(continue_time == 0)
  70. //                        {
  71. //                                continue_time = 1;
  72. //                                CarStop();
  73. //                        }
  74.                         //do something
  75.                         SearchRun();
  76.                         if(ctrl_comm_last != ctrl_comm)//指令发生变化
  77.                         {
  78.                                 ctrl_comm_last = ctrl_comm;
  79.                                 switch(ctrl_comm)
  80.                                 {
  81.                                         case COMM_UP:    CarGo();break;
  82.                                         case COMM_DOWN:  CarBack();break;
  83.                                         case COMM_LEFT:  CarLeft();break;
  84.                                         case COMM_RIGHT: CarRight();break;
  85.                                         case COMM_STOP:  CarStop();break;
  86.                                         default : break;
  87.                                 }
  88.                                 Delayms(10);//防抖
  89.                                 LCD1602WriteCommand(ctrl_comm);
  90.                         }
  91.                 }
  92.                
  93. }
  94. }
复制代码
  1. #include "IRCtrol.h"
  2. #include "interface.h"

  3. unsigned char ir_rec_flag=0;//接收数据标志位 1 有新数据 0 没有
  4. unsigned char IRCOM[4];

  5. //use time3 realize delay systick已经在main函数中使用了,在中断中不能重复使用
  6. void Time3Init(void)
  7. {
  8.     TIM_TimeBaseInitTypeDef  TIM_TimeBaseStructure;
  9.     RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM3, ENABLE);
  10.     TIM_TimeBaseStructure.TIM_Period = 1;
  11.     TIM_TimeBaseStructure.TIM_Prescaler = (72 - 1);//72M / 72 = 1us
  12.     TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Down;
  13.     TIM_TimeBaseInit(TIM3, &TIM_TimeBaseStructure);
  14. }

  15. //1us 延时
  16. void DelayUs(vu32 nCount)
  17. {
  18.   u16 TIMCounter = nCount;
  19.   TIM_Cmd(TIM3, ENABLE);
  20.   TIM_SetCounter(TIM3, TIMCounter);
  21.   while (TIMCounter>1)
  22.   {
  23.     TIMCounter = TIM_GetCounter(TIM3);
  24.   }
  25.   TIM_Cmd(TIM3, DISABLE);
  26. }

  27. //外部中断配置 红外遥控配置
  28. void IRCtrolInit(void)
  29. {
  30.         GPIO_InitTypeDef  GPIO_InitStructure;
  31.         EXTI_InitTypeDef         EXTI_InitStructure;//定义一个外部中断相关的结构体
  32.         NVIC_InitTypeDef NVIC_InitStructure; //定义一个中断的结构体
  33.        
  34.         RCC_APB2PeriphClockCmd(RCC_APB2Periph_AFIO , ENABLE);
  35.         GPIO_InitStructure.GPIO_Pin = IRIN_PIN;//配置使能GPIO管脚
  36.         GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IPU;//配置GPIO模式,输入上拉
  37.         GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;//配置GPIO端口速度
  38.         GPIO_Init(IRIN_GPIO , &GPIO_InitStructure);
  39.                
  40.         GPIO_EXTILineConfig(IRIN_PORTSOURCE , IRIN_PINSOURCE);
  41.         EXTI_InitStructure.EXTI_Line = IRIN_EXITLINE;//将对应的GPIO口连接到中断线上
  42.         EXTI_InitStructure.EXTI_Trigger = EXTI_Trigger_Falling;//中断事件类型,下降沿
  43.         EXTI_InitStructure.EXTI_Mode = EXTI_Mode_Interrupt;//选择模式,中断型
  44.         EXTI_InitStructure.EXTI_LineCmd = ENABLE;//使能该中断
  45.         EXTI_Init(&EXTI_InitStructure);//将配置好的参数写入寄存器
  46.                        
  47.         NVIC_PriorityGroupConfig(NVIC_PriorityGroup_0);         //阶级为0,不可嵌套
  48.         NVIC_InitStructure.NVIC_IRQChannel =         IRIN_IRQCH;//打开PINA_8的外部中断
  49.         NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 0;//主优先级0,最高
  50.         NVIC_InitStructure.NVIC_IRQChannelSubPriority = 0;        //子优先级,最低
  51.         NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE;        //使能该模块中断
  52.         NVIC_Init(&NVIC_InitStructure);        //中断初始化,将结构体定义的数据执行
  53.        
  54.         Time3Init();
  55. }

  56. /*******************************************************************************
  57. * 函 数 名 :DelayIr
  58. * 函数功能 :0.14MS 延时
  59. * 输    入 :无
  60. * 输    出 :无
  61. *******************************************************************************/
  62. void DelayIr(unsigned char x)  
  63. {
  64.   while(x--)
  65. {
  66.   DelayUs(140);
  67. }
  68. }

  69. void IRIntIsr(void)
  70. {
  71.   unsigned char j,k,N=0;
  72.          DelayIr(15);
  73.          if (IRIN==1)
  74.      {
  75.            return;
  76.           }
  77.                  continue_time = 40;//连发信号,表示指令持续 40*5 = 200ms 无指令停车
  78.                            //确认IR信号出现
  79.   while (!IRIN)            //等IR变为高电平,跳过9ms的前导低电平信号。
  80.     {DelayIr(1);}

  81. for (j=0;j<4;j++)         //收集四组数据
  82. {
  83.   for (k=0;k<8;k++)        //每组数据有8位
  84.   {
  85.    while (IRIN)            //等 IR 变为低电平,跳过4.5ms的前导高电平信号。
  86.      {DelayIr(1);}
  87.     while (!IRIN)          //等 IR 变为高电平
  88.      {DelayIr(1);}
  89.      while (IRIN)           //计算IR高电平时长
  90.       {
  91.     DelayIr(1);
  92.     N++;           
  93.     if (N>=30)
  94.          {
  95.          return;}                  //0.14ms计数过长自动离开。
  96.       }                        //高电平计数完毕               
  97.      IRCOM[j]=IRCOM[j] >> 1;                  //数据最高位补“0”
  98.      if (N>=8) {IRCOM[j] = IRCOM[j] | 0x80;}  //数据最高位补“1”
  99.      N=0;
  100.   }//end for k
  101. }//end for j
  102.    
  103.         k = ~IRCOM[3];
  104.    if (IRCOM[2] != k)
  105.    {
  106.      return; }
  107.          
  108.                  //指令转换
  109.                  
  110.                  switch(IRCOM[2])
  111.                  {
  112.                          case 0x46: ctrl_comm = COMM_UP;break;
  113.                          case 0x15: ctrl_comm = COMM_DOWN;break;
  114.                          case 0x44: ctrl_comm = COMM_LEFT;break;
  115.                          case 0x43: ctrl_comm = COMM_RIGHT;break;
  116.                          case 0x40: ctrl_comm = COMM_STOP;break;
  117.                          default :  return;
  118.                  }
  119.                  ir_rec_flag = 1;
  120.        
  121. }
复制代码

所有资料51hei提供下载:
红外黑线循迹.rar (272.46 KB, 下载次数: 31)
回复

使用道具 举报

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

本版积分规则

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

Powered by 单片机教程网

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